From 82f981d34c67efd975a85d4a899f829554d22ba4 Mon Sep 17 00:00:00 2001 From: luhuadong Date: Sat, 22 Feb 2020 21:00:35 +0800 Subject: [PATCH] [Sensor] Support custom commands for rt_sensor_control --- components/drivers/sensors/sensor.c | 7 +++++-- 1 file changed, 5 insertions(+), 2 deletions(-) diff --git a/components/drivers/sensors/sensor.c b/components/drivers/sensors/sensor.c index 18c5830fbf..fc50c40044 100644 --- a/components/drivers/sensors/sensor.c +++ b/components/drivers/sensors/sensor.c @@ -307,7 +307,7 @@ static rt_err_t rt_sensor_control(rt_device_t dev, int cmd, void *args) case RT_SENSOR_CTRL_GET_ID: if (args) { - sensor->ops->control(sensor, RT_SENSOR_CTRL_GET_ID, args); + result = sensor->ops->control(sensor, RT_SENSOR_CTRL_GET_ID, args); } break; case RT_SENSOR_CTRL_GET_INFO: @@ -352,7 +352,10 @@ static rt_err_t rt_sensor_control(rt_device_t dev, int cmd, void *args) result = sensor->ops->control(sensor, RT_SENSOR_CTRL_SELF_TEST, args); break; default: - return -RT_ERROR; + + /* Custom commands */ + result = sensor->ops->control(sensor, cmd, args); + break; } if (sensor->module) -- GitLab