diff options
Diffstat (limited to 'src/driver/bme680_util.cc')
| -rw-r--r-- | src/driver/bme680_util.cc | 27 |
1 files changed, 27 insertions, 0 deletions
diff --git a/src/driver/bme680_util.cc b/src/driver/bme680_util.cc new file mode 100644 index 0000000..cb9b529 --- /dev/null +++ b/src/driver/bme680_util.cc @@ -0,0 +1,27 @@ +#include "arch.h" +#include "driver/i2c.h" +#include <stdint.h> + +void bme680_delay_ms(uint32_t const period) +{ + arch.delay_ms(period); +} + +int8_t bme680_i2c_read(uint8_t dev_id, uint8_t reg_addr, uint8_t *reg_data, uint16_t len) +{ + int8_t ret = i2c.xmit(dev_id, 1, ®_addr, 0, 0); + if (ret) { + return ret; + } + return i2c.xmit(dev_id, 0, 0, len, reg_data); +} + +int8_t bme680_i2c_write(uint8_t dev_id, uint8_t reg_addr, uint8_t *reg_data, uint16_t len) +{ + unsigned char txbuf[len+1]; + txbuf[0] = reg_addr; + for (uint16_t i = 0; i < len; i++) { + txbuf[i+1] = reg_data[i]; + } + return i2c.xmit(dev_id, len + 1, txbuf, 0, 0); +} |