[Sensor] Support custom commands for rt_sensor_control

This commit is contained in:
luhuadong 2020-02-22 21:00:35 +08:00
parent 5482794956
commit 82f981d34c
1 changed files with 5 additions and 2 deletions

View File

@ -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: case RT_SENSOR_CTRL_GET_ID:
if (args) if (args)
{ {
sensor->ops->control(sensor, RT_SENSOR_CTRL_GET_ID, args); result = sensor->ops->control(sensor, RT_SENSOR_CTRL_GET_ID, args);
} }
break; break;
case RT_SENSOR_CTRL_GET_INFO: 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); result = sensor->ops->control(sensor, RT_SENSOR_CTRL_SELF_TEST, args);
break; break;
default: default:
return -RT_ERROR;
/* Custom commands */
result = sensor->ops->control(sensor, cmd, args);
break;
} }
if (sensor->module) if (sensor->module)