fix(bme680): Lock I2C bus when accessing it

Signed-off-by: Rahix <rahix@rahix.de>

epicardium/modules/bme680.c

@@ -20,6 +20,8 @@ static struct bme680_dev bme;
 static int convert_error(int8_t error)
 {
 	switch (error) {
+	case BME680_OK:
+		return 0;
 	case BME680_E_NULL_PTR:
 		return EFAULT;
 	case BME680_E_COM_FAIL:
@@ -37,7 +39,14 @@ int epic_bme680_init()
 {
 	int8_t result = BME680_OK;
 
-	if (__builtin_expect(!initialized, 0)) {
+	if (initialized) {
+		return 0;
+	}
+
+	if (hwlock_acquire(HWLOCK_I2C, pdMS_TO_TICKS(100)) < 0) {
+		return -EBUSY;
+	}
+
 	bme.dev_id   = BME680_I2C_ADDR_PRIMARY;
 	bme.intf     = BME680_I2C_INTF;
 	bme.read     = card10_bosch_i2c_read;
@@ -54,7 +63,7 @@ int epic_bme680_init()
 	result = bme680_init(&bme);
 	if (result != BME680_OK) {
 		LOG_ERR("bme680", "bme680_init error: %d\n", result);
-			return -convert_error(result);
+		goto err;
 	}
 
 	/*
@@ -85,26 +94,32 @@ int epic_bme680_init()
 		LOG_ERR("bme680",
 			"bme680_set_sensor_settings error: %d\n",
 			result);
-			return -convert_error(result);
+		goto err;
 	}
 
 	initialized = true;
-	}
-	return 0;
+	result      = BME680_OK;
+err:
+	hwlock_release(HWLOCK_I2C);
+	return -convert_error(result);
 }
 
 int epic_bme680_deinit()
 {
-	if (initialized) {
+	if (!initialized) {
+		return 0;
+	}
+
+	if (hwlock_acquire(HWLOCK_I2C, pdMS_TO_TICKS(100)) < 0) {
+		return -EBUSY;
+	}
+
 	int8_t result = bme680_soft_reset(&bme);
 	if (result != BME680_OK) {
-			LOG_ERR("bme680",
-				"bme680_soft_reset error: %d\n",
-				result);
-			return -convert_error(result);
-		}
+		LOG_ERR("bme680", "bme680_soft_reset error: %d\n", result);
 	}
 
+	hwlock_release(HWLOCK_I2C);
 	initialized = false;
 	return 0;
 }
@@ -118,23 +133,34 @@ int epic_bme680_read_sensors(struct bme680_sensor_data *data)
 		return -EINVAL;
 	}
 
+	if (hwlock_acquire(HWLOCK_I2C, pdMS_TO_TICKS(100)) < 0) {
+		return -EBUSY;
+	}
+
 	uint16_t profile_dur = 0;
 	bme680_get_profile_dur(&profile_dur, &bme);
 
 	result = bme680_set_sensor_mode(&bme); /* Trigger a measurement */
 	if (result != BME680_OK) {
 		LOG_ERR("bme680", "bme680_set_sensor_mode error: %d\n", result);
-		return -convert_error(result);
+		goto err;
 	}
 
-	vTaskDelay(pdMS_TO_TICKS(
-		profile_dur)); /* Wait for the measurement to complete */
+	/*
+	 * Wait for the measurement to complete.  Release the I2C lock in the
+	 * meantime.
+	 */
+	hwlock_release(HWLOCK_I2C);
+	vTaskDelay(pdMS_TO_TICKS(profile_dur));
+	if (hwlock_acquire(HWLOCK_I2C, pdMS_TO_TICKS(100)) < 0) {
+		return -EBUSY;
+	}
 
 	struct bme680_field_data raw_data;
 	result = bme680_get_sensor_data(&raw_data, &bme);
 	if (result != BME680_OK) {
 		LOG_ERR("bme680", "bme680_get_sensor_data error: %d\n", result);
-		return -convert_error(result);
+		goto err;
 	}
 
 	data->temperature    = (float)raw_data.temperature / 100.0f;
@@ -142,5 +168,8 @@ int epic_bme680_read_sensors(struct bme680_sensor_data *data)
 	data->pressure       = raw_data.pressure / 100.0f;
 	data->gas_resistance = raw_data.gas_resistance;
 
-	return 0;
+	result = BME680_OK;
+err:
+	hwlock_release(HWLOCK_I2C);
+	return -convert_error(result);
 }