Check if fetch channel is supported

4 years ago · a67a8cd3b8
1 changed files with 5 additions and 0 deletions
--- a/app/drivers/zephyr/battery_voltage_divider.c
+++ b/app/drivers/zephyr/battery_voltage_divider.c
@ -58,6 +58,11 @@ static int bvd_sample_fetch(struct device *dev, enum sensor_channel chan) {
				@@ -58,6 +58,11 @@ static int bvd_sample_fetch(struct device *dev, enum sensor_channel chan) {
    const struct bvd_config *drv_cfg = dev->config_info;
    struct adc_sequence *as = &drv_data->as;

+    // Make sure selected channel is supported
+    if (chan != SENSOR_CHAN_GAUGE_VOLTAGE && chan != SENSOR_CHAN_GAUGE_STATE_OF_CHARGE) {
+        return -ENOTSUP;
+    }
+
    int rc = 0;

    // Enable power GPIO if present