Obbart/ETcontroller_PRO
1
0
Fork 0
Code Issues Pull Requests Actions Packages Projects Releases Wiki Activity

Added STM32 platform for debugging and development

Browse Source
This commit is contained in:
Emanuele Trabattoni
2025-06-27 18:55:20 +02:00
parent 01db0e543f
commit 3d2d44c0bb
9 changed files with 171 additions and 94 deletions
Download Patch File Download Diff File Expand all files Collapse all files

26
lib/I2C/I2C_Driver.cpp
View File

@@ -17,7 +17,7 @@ namespace drivers
const bool I2C::read(const uint8_t deviceAddr, const uint8_t deviceReg, const uint8_t len, std::vector<uint8_t> &data)
{
busy.try_lock();
//busy.try_lock();
Wire.beginTransmission(deviceAddr);
Wire.write(deviceReg);
switch (Wire.endTransmission(true))
@@ -25,19 +25,19 @@ namespace drivers
case 0:
break; // no error, break switch
case 1:
log_e("Data to long to fit in buffer: [%d]", len);
LOG_ERROR("Data to long to fit in buffer: [%d]", len);
case 2:
log_e("Received NAK on address transmit");
LOG_ERROR("Received NAK on address transmit");
case 3:
log_e("Received NAK on data transmit");
LOG_ERROR("Received NAK on data transmit");
case 4:
log_e("Unknown Error");
LOG_ERROR("Unknown Error");
return false;
}
const uint8_t nBytes = Wire.requestFrom(deviceAddr, len);
if (nBytes < len)
{
log_w("Received data is less than expected: len[%d], nBytes[%d]", len, nBytes);
LOG_ERROR("Received data is less than expected: len[%d], nBytes[%d]", len, nBytes);
}
data.clear();
data.resize(nBytes); // resize out buffer to received data len, no check if data len is correct
@@ -45,13 +45,13 @@ namespace drivers
{
data[i] = static_cast<uint8_t>(Wire.read());
}
busy.unlock();
//busy.unlock();
return true;
}
const bool I2C::write(const uint8_t deviceAddr, const uint8_t deviceReg, const std::vector<uint8_t> &data)
{
busy.lock();
//busy.lock();
Wire.beginTransmission(deviceAddr);
Wire.write(deviceReg);
for (auto d : data)
@@ -64,16 +64,16 @@ namespace drivers
case 0:
break; // no error, break switch
case 1:
log_e("Data to long to fit in buffer: [%d]", data.size());
LOG_ERROR("Data to long to fit in buffer: [%d]", data.size());
case 2:
log_e("Received NAK on address transmit");
LOG_ERROR("Received NAK on address transmit");
case 3:
log_e("Received NAK on data transmit");
LOG_ERROR("Received NAK on data transmit");
case 4:
log_e("Unknown Error");
LOG_ERROR("Unknown Error");
return false;
}
busy.unlock();
//busy.unlock();
return true;
}