pohui_pohui/firmware
1
0
Fork 0
mirror of https://github.com/meshtastic/firmware.git synced 2025-08-02 11:55:56 +00:00
Code Issues Actions 4 Packages Projects Releases Wiki Activity

Further (non-working) progress in SEN5X

Browse Source
This commit is contained in:
oscgonfer 2025-07-08 12:07:25 +02:00 committed by Thomas Göttgens
parent d7bb0f7cdf
commit f43fbe0068
3 changed files with 20 additions and 2 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

2
src/detect/ScanI2CTwoWire.cpp
View File

@ -522,12 +522,12 @@ void ScanI2CTwoWire::scanPort(I2CPort port, uint8_t *address, uint8_t asize)
case ICM20948_ADDR_ALT: // same as MPU6050_ADDR case ICM20948_ADDR_ALT: // same as MPU6050_ADDR
// ICM20948 Register check // ICM20948 Register check
registerValue = getRegisterValue(ScanI2CTwoWire::RegisterLocation(addr, 0x00), 1); registerValue = getRegisterValue(ScanI2CTwoWire::RegisterLocation(addr, 0x00), 1);
prod = readSEN5xProductName(i2cBus, addr.address);
if (registerValue == 0xEA) { if (registerValue == 0xEA) {
type = ICM20948; type = ICM20948;
logFoundDevice("ICM20948", (uint8_t)addr.address); logFoundDevice("ICM20948", (uint8_t)addr.address);
break; break;
} else { } else {
prod = readSEN5xProductName(i2cBus, addr.address);
if (prod.startsWith("SEN55")) { if (prod.startsWith("SEN55")) {
type = SEN5X; type = SEN5X;
logFoundDevice("Sensirion SEN55", addr.address); logFoundDevice("Sensirion SEN55", addr.address);

19
src/modules/Telemetry/Sensor/SEN5XSensor.cpp
View File

@ -101,6 +101,7 @@ bool SEN5XSensor::sendCommand(uint16_t command, uint8_t* buffer, uint8_t byteNum
} }
// Transmit the data // Transmit the data
LOG_INFO("Beginning connection to SEN5X: 0x%x", address);
bus->beginTransmission(address); bus->beginTransmission(address);
size_t writtenBytes = bus->write(toSend, bufferSize); size_t writtenBytes = bus->write(toSend, bufferSize);
uint8_t i2c_error = bus->endTransmission(); uint8_t i2c_error = bus->endTransmission();
@ -164,17 +165,33 @@ uint8_t SEN5XSensor::CRC(uint8_t* buffer)
return crc; return crc;
} }
bool SEN5XSensor::I2Cdetect(TwoWire *_Wire, uint8_t address)
{
_Wire->beginTransmission(address);
byte error = _Wire->endTransmission();
if (error == 0) return true;
else return false;
}
int32_t SEN5XSensor::runOnce() int32_t SEN5XSensor::runOnce()
{ {
state = SEN5X_NOT_DETECTED;
LOG_INFO("Init sensor: %s", sensorName); LOG_INFO("Init sensor: %s", sensorName);
if (!hasSensor()) { if (!hasSensor()) {
return DEFAULT_SENSOR_MINIMUM_WAIT_TIME_BETWEEN_READS; return DEFAULT_SENSOR_MINIMUM_WAIT_TIME_BETWEEN_READS;
} }
bus = nodeTelemetrySensorsMap[sensorType].second; bus = nodeTelemetrySensorsMap[sensorType].second;
address = (uint8_t)nodeTelemetrySensorsMap[sensorType].first;
// sen5x.begin(*bus); // sen5x.begin(*bus);
delay(50); // without this there is an error on the deviceReset function if (!I2Cdetect(bus, address)) {
LOG_INFO("SEN5X ERROR no device found on adress");
return DEFAULT_SENSOR_MINIMUM_WAIT_TIME_BETWEEN_READS;
}
delay(25);
if (!sendCommand(SEN5X_RESET)) { if (!sendCommand(SEN5X_RESET)) {
LOG_ERROR("SEN5X: Error reseting device"); LOG_ERROR("SEN5X: Error reseting device");

1
src/modules/Telemetry/Sensor/SEN5XSensor.h
View File

@ -49,6 +49,7 @@ class SEN5XSensor : public TelemetrySensor
bool sendCommand(uint16_t wichCommand, uint8_t* buffer, uint8_t byteNumber=0); bool sendCommand(uint16_t wichCommand, uint8_t* buffer, uint8_t byteNumber=0);
uint8_t readBuffer(uint8_t* buffer, uint8_t byteNumber); // Return number of bytes received uint8_t readBuffer(uint8_t* buffer, uint8_t byteNumber); // Return number of bytes received
uint8_t CRC(uint8_t* buffer); uint8_t CRC(uint8_t* buffer);
bool I2Cdetect(TwoWire *_Wire, uint8_t address);
protected: protected:
virtual void setup() override; virtual void setup() override;