diff --git a/components/drivers/sensors/sensor.c b/components/drivers/sensors/sensor.c index ce593e17bb0aeedf262b0906683e3742bed95130..08127bc292a40b2c6442d68f630a407025f1cc19 100644 --- a/components/drivers/sensors/sensor.c +++ b/components/drivers/sensors/sensor.c @@ -354,8 +354,15 @@ static rt_err_t rt_sensor_control(rt_device_t dev, int cmd, void *args) break; default: - /* Custom commands */ - result = sensor->ops->control(sensor, cmd, args); + if (cmd > RT_SENSOR_CTRL_USER_CMD_START) + { + /* Custom commands */ + result = sensor->ops->control(sensor, cmd, args); + } + else + { + result = -RT_ERROR; + } break; } diff --git a/components/drivers/sensors/sensor.h b/components/drivers/sensors/sensor.h index 0dae3d66f57c8f7f86aaaf82cf378655a04d320e..a0eaaae9ea2809bde60e874799d151225e725c6a 100755 --- a/components/drivers/sensors/sensor.h +++ b/components/drivers/sensors/sensor.h @@ -111,6 +111,8 @@ extern "C" { #define RT_SENSOR_CTRL_SET_POWER (5) /* Set power mode. args type of sensor power mode. ex. RT_SENSOR_POWER_DOWN,RT_SENSOR_POWER_NORMAL */ #define RT_SENSOR_CTRL_SELF_TEST (6) /* Take a self test */ +#define RT_SENSOR_CTRL_USER_CMD_START 0x100 /* User commands should be greater than 0x100 */ + struct rt_sensor_info { rt_uint8_t type; /* The sensor type */