diff options
Diffstat (limited to 'src/driver')
-rw-r--r-- | src/driver/sen5x.cc | 29 |
1 files changed, 29 insertions, 0 deletions
diff --git a/src/driver/sen5x.cc b/src/driver/sen5x.cc index 2a5d6b8..9edbcd0 100644 --- a/src/driver/sen5x.cc +++ b/src/driver/sen5x.cc @@ -11,6 +11,13 @@ #include "driver/soft_i2c.h" #endif +void SEN5x::cleanFan() +{ + txbuf[0] = 0x56; + txbuf[1] = 0x07; + i2c.xmit(address, 2, txbuf, 0, rxbuf); +} + void SEN5x::start() { txbuf[0] = 0x00; @@ -48,4 +55,26 @@ bool SEN5x::read() return true; } +bool SEN5x::readStatus() +{ + txbuf[0] = 0xd2; + txbuf[1] = 0x06; + if (i2c.xmit(address, 2, txbuf, 0, rxbuf)) { + return false; + } + arch.delay_ms(20); + if (i2c.xmit(address, 0, txbuf, 6, rxbuf)) { + return false; + } + + fan_speed_warning = rxbuf[1] & 0x20; + fan_cleaning_active = rxbuf[1] & 0x08; + gas_sensor_error = rxbuf[4] & 0x80; + rht_sensor_error = rxbuf[4] & 0x40; + laser_failure = rxbuf[4] & 0x20; + fan_failure = rxbuf[4] & 0x10; + + return true; +} + SEN5x sen5x; |