Add Bosch SensorTec BME680 driver + utilities

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, &reg_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);
+}