浏览代码

[Sensor] Support custom commands for rt_sensor_control

luhuadong 5 年之前
父节点
当前提交
82f981d34c
共有 1 个文件被更改,包括 5 次插入2 次删除
  1. 5 2
      components/drivers/sensors/sensor.c

+ 5 - 2
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)