[Sensor] Support custom commands for rt_sensor_control

luhuadong · luhuadong · commit 82f981d34c67 · 2020-02-22T21:00:35.000+08:00
diff --git 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)

Original file line number	Diff line number	Diff line change
`@@ -307,7 +307,7 @@ static rt_err_t rt_sensor_control(rt_device_t dev, int cmd, void *args)`
`307`	`307`	`case RT_SENSOR_CTRL_GET_ID:`
`308`	`308`	`if (args)`
`309`	`309`	`{`
`310`		`- sensor->ops->control(sensor, RT_SENSOR_CTRL_GET_ID, args);`
	`310`	`+ result = sensor->ops->control(sensor, RT_SENSOR_CTRL_GET_ID, args);`
`311`	`311`	`}`
`312`	`312`	`break;`
`313`	`313`	`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)`
`352`	`352`	`result = sensor->ops->control(sensor, RT_SENSOR_CTRL_SELF_TEST, args);`
`353`	`353`	`break;`
`354`	`354`	`default:`
`355`		`- return -RT_ERROR;`
	`355`	`+`
	`356`	`+ /* Custom commands */`
	`357`	`+ result = sensor->ops->control(sensor, cmd, args);`
	`358`	`+ break;`
`356`	`359`	`}`
`357`	`360`
`358`	`361`	`if (sensor->module)`