mirror of https://github.com/g4klx/MMDVM.git
Most of the I2C work completed, now need to review the low-level I2C code.
This commit is contained in:
parent
112a136060
commit
6c8cf7a838
|
@ -146,10 +146,11 @@ extern CIO io;
|
||||||
|
|
||||||
#if defined(MODE_OLED)
|
#if defined(MODE_OLED)
|
||||||
extern CI2COLED oled;
|
extern CI2COLED oled;
|
||||||
|
extern CI2CPort i2C3;
|
||||||
#endif
|
#endif
|
||||||
|
|
||||||
#if defined(I2C_REPEATER)
|
#if defined(I2C_REPEATER)
|
||||||
extern CI2CPort i2c1;
|
extern CI2CPort i2C1;
|
||||||
#endif
|
#endif
|
||||||
|
|
||||||
#if defined(MODE_DSTAR)
|
#if defined(MODE_DSTAR)
|
||||||
|
|
14
I2COLED.cpp
14
I2COLED.cpp
|
@ -21,6 +21,7 @@
|
||||||
#if defined(MODE_OLED)
|
#if defined(MODE_OLED)
|
||||||
|
|
||||||
#include "I2COLED.h"
|
#include "I2COLED.h"
|
||||||
|
#include "I2CPort.h"
|
||||||
|
|
||||||
#include "Globals.h"
|
#include "Globals.h"
|
||||||
|
|
||||||
|
@ -304,7 +305,6 @@ const uint8_t FONT[] = {
|
||||||
|
|
||||||
|
|
||||||
CI2COLED::CI2COLED() :
|
CI2COLED::CI2COLED() :
|
||||||
m_i2c(3U),
|
|
||||||
m_oledBuffer(NULL)
|
m_oledBuffer(NULL)
|
||||||
{
|
{
|
||||||
m_oledBuffer = new uint8_t[OLED_BUFFER_SIZE];
|
m_oledBuffer = new uint8_t[OLED_BUFFER_SIZE];
|
||||||
|
@ -314,7 +314,7 @@ m_oledBuffer(NULL)
|
||||||
|
|
||||||
bool CI2COLED::init()
|
bool CI2COLED::init()
|
||||||
{
|
{
|
||||||
bool ret = m_i2c.init();
|
bool ret = i2C3.init();
|
||||||
if (!ret)
|
if (!ret)
|
||||||
return false;
|
return false;
|
||||||
|
|
||||||
|
@ -409,7 +409,7 @@ void CI2COLED::sendCommand(uint8_t c0, uint8_t c1, uint8_t c2)
|
||||||
buff[4U] = c2;
|
buff[4U] = c2;
|
||||||
|
|
||||||
// Write Data on I2C
|
// Write Data on I2C
|
||||||
m_i2c.write(buff, 5U);
|
i2C3.write(buff, 5U);
|
||||||
}
|
}
|
||||||
|
|
||||||
void CI2COLED::sendCommand(uint8_t c0, uint8_t c1)
|
void CI2COLED::sendCommand(uint8_t c0, uint8_t c1)
|
||||||
|
@ -422,7 +422,7 @@ void CI2COLED::sendCommand(uint8_t c0, uint8_t c1)
|
||||||
buff[3U] = c1;
|
buff[3U] = c1;
|
||||||
|
|
||||||
// Write Data on I2C
|
// Write Data on I2C
|
||||||
m_i2c.write(buff, 4U);
|
i2C3.write(buff, 4U);
|
||||||
}
|
}
|
||||||
|
|
||||||
void CI2COLED::sendCommand(uint8_t c)
|
void CI2COLED::sendCommand(uint8_t c)
|
||||||
|
@ -434,7 +434,7 @@ void CI2COLED::sendCommand(uint8_t c)
|
||||||
buff[2U] = c;
|
buff[2U] = c;
|
||||||
|
|
||||||
// Write Data on I2C
|
// Write Data on I2C
|
||||||
m_i2c.write(buff, 3U);
|
i2C3.write(buff, 3U);
|
||||||
}
|
}
|
||||||
|
|
||||||
void CI2COLED::sendData(const uint8_t* data, uint16_t length)
|
void CI2COLED::sendData(const uint8_t* data, uint16_t length)
|
||||||
|
@ -445,8 +445,8 @@ void CI2COLED::sendData(const uint8_t* data, uint16_t length)
|
||||||
buff[1U] = SSD_Data_Mode;
|
buff[1U] = SSD_Data_Mode;
|
||||||
|
|
||||||
// Write Data on I2C
|
// Write Data on I2C
|
||||||
m_i2c.write(buff, 2U);
|
i2C3.write(buff, 2U);
|
||||||
m_i2c.write(data, length);
|
i2C3.write(data, length);
|
||||||
}
|
}
|
||||||
|
|
||||||
void CI2COLED::clear()
|
void CI2COLED::clear()
|
||||||
|
|
|
@ -25,8 +25,6 @@
|
||||||
|
|
||||||
#include <cstdint>
|
#include <cstdint>
|
||||||
|
|
||||||
#include "I2CPort.h"
|
|
||||||
|
|
||||||
class CI2COLED {
|
class CI2COLED {
|
||||||
public:
|
public:
|
||||||
CI2COLED();
|
CI2COLED();
|
||||||
|
@ -36,7 +34,6 @@ public:
|
||||||
void setMode(int state);
|
void setMode(int state);
|
||||||
|
|
||||||
private:
|
private:
|
||||||
CI2CPort m_i2c;
|
|
||||||
uint8_t* m_oledBuffer;
|
uint8_t* m_oledBuffer;
|
||||||
|
|
||||||
void write(const char* text);
|
void write(const char* text);
|
||||||
|
|
115
I2CPort.cpp
115
I2CPort.cpp
|
@ -1,3 +1,4 @@
|
||||||
|
|
||||||
/*
|
/*
|
||||||
* Copyright (C) 2020 by Jonathan Naylor G4KLX
|
* Copyright (C) 2020 by Jonathan Naylor G4KLX
|
||||||
*
|
*
|
||||||
|
@ -30,9 +31,54 @@
|
||||||
#include "stm32f7xx_i2c.h"
|
#include "stm32f7xx_i2c.h"
|
||||||
#endif
|
#endif
|
||||||
|
|
||||||
|
#include "Globals.h"
|
||||||
|
|
||||||
const uint32_t I2C_CLK_FREQ = 100000U; // XXX FIXME
|
const uint32_t I2C_CLK_FREQ = 100000U; // XXX FIXME
|
||||||
const uint16_t I2C_ADDR = 0U; // XXX FIXME
|
const uint16_t I2C_ADDR = 0U; // XXX FIXME
|
||||||
|
|
||||||
|
|
||||||
|
extern "C" {
|
||||||
|
#if defined(I2C_REPEATER)
|
||||||
|
void I2C1_EV_IRQHandler(void)
|
||||||
|
{
|
||||||
|
i2C1.eventHandler();
|
||||||
|
}
|
||||||
|
|
||||||
|
void I2C1_ER_IRQHandler(void)
|
||||||
|
{
|
||||||
|
if (I2C_GetITStatus(I2C1, I2C_IT_AF))
|
||||||
|
I2C_ClearITPendingBit(I2C1, I2C_IT_AF);
|
||||||
|
}
|
||||||
|
#endif
|
||||||
|
|
||||||
|
#ifdef notdef
|
||||||
|
void I2C2_EV_IRQHandler(void)
|
||||||
|
{
|
||||||
|
i2C2.eventHandler();
|
||||||
|
}
|
||||||
|
|
||||||
|
void I2C2_ER_IRQHandler(void)
|
||||||
|
{
|
||||||
|
if (I2C_GetITStatus(I2C2, I2C_IT_AF))
|
||||||
|
I2C_ClearITPendingBit(I2C2, I2C_IT_AF);
|
||||||
|
}
|
||||||
|
#endif
|
||||||
|
|
||||||
|
#if defined(MODE_OLED)
|
||||||
|
void I2C3_EV_IRQHandler(void)
|
||||||
|
{
|
||||||
|
i2C3.eventHandler();
|
||||||
|
}
|
||||||
|
|
||||||
|
void I2C3_ER_IRQHandler(void)
|
||||||
|
{
|
||||||
|
if (I2C_GetITStatus(I2C3, I2C_IT_AF))
|
||||||
|
I2C_ClearITPendingBit(I2C3, I2C_IT_AF);
|
||||||
|
}
|
||||||
|
#endif
|
||||||
|
}
|
||||||
|
|
||||||
|
|
||||||
CI2CPort::CI2CPort(uint8_t n) :
|
CI2CPort::CI2CPort(uint8_t n) :
|
||||||
m_n(n),
|
m_n(n),
|
||||||
m_ok(false),
|
m_ok(false),
|
||||||
|
@ -129,6 +175,75 @@ uint8_t CI2CPort::write(const uint8_t* data, uint8_t length)
|
||||||
return 0U;
|
return 0U;
|
||||||
}
|
}
|
||||||
|
|
||||||
|
void CI2CPort::eventHandler()
|
||||||
|
{
|
||||||
|
I2C_TypeDef* i2CPort = NULL;
|
||||||
|
|
||||||
|
switch (m_n) {
|
||||||
|
case 1U:
|
||||||
|
i2CPort = I2C1;
|
||||||
|
break;
|
||||||
|
case 2U:
|
||||||
|
i2CPort = I2C2;
|
||||||
|
break;
|
||||||
|
case 3U:
|
||||||
|
i2CPort = I2C3;
|
||||||
|
break;
|
||||||
|
default:
|
||||||
|
return;
|
||||||
|
}
|
||||||
|
|
||||||
|
uint32_t event = I2C_GetLastEvent(i2CPort);
|
||||||
|
|
||||||
|
switch (event) {
|
||||||
|
case I2C_EVENT_SLAVE_TRANSMITTER_ADDRESS_MATCHED:
|
||||||
|
case I2C_EVENT_SLAVE_BYTE_TRANSMITTED:
|
||||||
|
if (fifoLevel() > 0U) {
|
||||||
|
I2C_SendData(i2CPort, m_fifo[m_fifoTail]);
|
||||||
|
m_fifoTail++;
|
||||||
|
if (m_fifoTail >= I2C_TX_FIFO_SIZE)
|
||||||
|
m_fifoTail = 0U;
|
||||||
|
} else
|
||||||
|
I2C_SendData(i2CPort, 0U);
|
||||||
|
break;
|
||||||
|
|
||||||
|
case I2C_EVENT_SLAVE_STOP_DETECTED:
|
||||||
|
clearFlag();
|
||||||
|
break;
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
void CI2CPort::clearFlag()
|
||||||
|
{
|
||||||
|
I2C_TypeDef* i2CPort = NULL;
|
||||||
|
|
||||||
|
switch (m_n) {
|
||||||
|
case 1U:
|
||||||
|
i2CPort = I2C1;
|
||||||
|
break;
|
||||||
|
case 2U:
|
||||||
|
i2CPort = I2C2;
|
||||||
|
break;
|
||||||
|
case 3U:
|
||||||
|
i2CPort = I2C3;
|
||||||
|
break;
|
||||||
|
default:
|
||||||
|
return;
|
||||||
|
}
|
||||||
|
|
||||||
|
// Clear ADDR flag
|
||||||
|
while((i2CPort->SR1 & I2C_SR1_ADDR) == I2C_SR1_ADDR) {
|
||||||
|
i2CPort->SR1;
|
||||||
|
i2CPort->SR2;
|
||||||
|
}
|
||||||
|
|
||||||
|
// Clear STOPF flag
|
||||||
|
while((i2CPort->SR1 & I2C_SR1_STOPF) == I2C_SR1_STOPF) {
|
||||||
|
i2CPort->SR1;
|
||||||
|
i2CPort->CR1 |= 0x1;
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
uint16_t CI2CPort::fifoLevel()
|
uint16_t CI2CPort::fifoLevel()
|
||||||
{
|
{
|
||||||
uint32_t tail = m_fifoTail;
|
uint32_t tail = m_fifoTail;
|
||||||
|
|
|
@ -36,6 +36,8 @@ public:
|
||||||
|
|
||||||
uint8_t write(const uint8_t* data, uint8_t length);
|
uint8_t write(const uint8_t* data, uint8_t length);
|
||||||
|
|
||||||
|
void eventHandler();
|
||||||
|
|
||||||
private:
|
private:
|
||||||
uint8_t m_n;
|
uint8_t m_n;
|
||||||
bool m_ok;
|
bool m_ok;
|
||||||
|
@ -45,6 +47,7 @@ private:
|
||||||
|
|
||||||
uint16_t fifoLevel();
|
uint16_t fifoLevel();
|
||||||
bool fifoPut(uint8_t next);
|
bool fifoPut(uint8_t next);
|
||||||
|
void clearFlag();
|
||||||
};
|
};
|
||||||
|
|
||||||
#endif
|
#endif
|
||||||
|
|
|
@ -196,7 +196,7 @@ void CIO::initInt()
|
||||||
#endif
|
#endif
|
||||||
|
|
||||||
#if defined(I2C_REPEATER)
|
#if defined(I2C_REPEATER)
|
||||||
i2c1.init();
|
i2C1.init();
|
||||||
#endif
|
#endif
|
||||||
}
|
}
|
||||||
|
|
||||||
|
|
|
@ -43,10 +43,11 @@ bool m_dcd = false;
|
||||||
|
|
||||||
#if defined(MODE_OLED)
|
#if defined(MODE_OLED)
|
||||||
CI2COLED oled;
|
CI2COLED oled;
|
||||||
|
CI2CPort i2C3(3U);
|
||||||
#endif
|
#endif
|
||||||
|
|
||||||
#if defined(I2C_REPEATER)
|
#if defined(I2C_REPEATER)
|
||||||
CI2CPort i2c1(1U);
|
CI2CPort i2C1(1U);
|
||||||
#endif
|
#endif
|
||||||
|
|
||||||
#if defined(MODE_DSTAR)
|
#if defined(MODE_DSTAR)
|
||||||
|
|
|
@ -40,6 +40,7 @@ bool m_dcd = false;
|
||||||
|
|
||||||
#if defined(MODE_OLED)
|
#if defined(MODE_OLED)
|
||||||
CI2COLED oled;
|
CI2COLED oled;
|
||||||
|
CI2CPort i2C3(3U);
|
||||||
#endif
|
#endif
|
||||||
|
|
||||||
#if defined(I2C_REPEATER)
|
#if defined(I2C_REPEATER)
|
||||||
|
|
|
@ -1313,7 +1313,7 @@ void CSerialPort::processMessage(uint8_t type, const uint8_t* buffer, uint16_t l
|
||||||
|
|
||||||
#if defined(I2C_REPEATER)
|
#if defined(I2C_REPEATER)
|
||||||
case MMDVM_I2C_DATA: {
|
case MMDVM_I2C_DATA: {
|
||||||
err = i2c1.write(buffer, length);
|
err = i2C1.write(buffer, length);
|
||||||
if (err != 0U) {
|
if (err != 0U) {
|
||||||
DEBUG2("Received invalid I2C data", err);
|
DEBUG2("Received invalid I2C data", err);
|
||||||
sendNAK(err);
|
sendNAK(err);
|
||||||
|
|
Loading…
Reference in New Issue