[sensor] Fixed error with mutex_lock take and release not matching.| 修复锁的获取和释放不对应的错误.
This commit is contained in:
parent
44abc90990
commit
2600f82e39
|
@ -139,6 +139,7 @@ static rt_err_t rt_sensor_open(rt_device_t dev, rt_uint16_t oflag)
|
||||||
{
|
{
|
||||||
rt_sensor_t sensor = (rt_sensor_t)dev;
|
rt_sensor_t sensor = (rt_sensor_t)dev;
|
||||||
RT_ASSERT(dev != RT_NULL);
|
RT_ASSERT(dev != RT_NULL);
|
||||||
|
rt_err_t res = RT_EOK;
|
||||||
|
|
||||||
if (sensor->module)
|
if (sensor->module)
|
||||||
{
|
{
|
||||||
|
@ -152,7 +153,8 @@ static rt_err_t rt_sensor_open(rt_device_t dev, rt_uint16_t oflag)
|
||||||
sensor->data_buf = rt_malloc(sizeof(struct rt_sensor_data) * sensor->info.fifo_max);
|
sensor->data_buf = rt_malloc(sizeof(struct rt_sensor_data) * sensor->info.fifo_max);
|
||||||
if (sensor->data_buf == RT_NULL)
|
if (sensor->data_buf == RT_NULL)
|
||||||
{
|
{
|
||||||
return -RT_ENOMEM;
|
res = -RT_ENOMEM;
|
||||||
|
goto __exit;
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
|
|
||||||
|
@ -186,12 +188,8 @@ static rt_err_t rt_sensor_open(rt_device_t dev, rt_uint16_t oflag)
|
||||||
}
|
}
|
||||||
else
|
else
|
||||||
{
|
{
|
||||||
if (sensor->module)
|
res = -RT_EINVAL;
|
||||||
{
|
goto __exit;
|
||||||
/* release the module mutex */
|
|
||||||
rt_mutex_release(sensor->module->lock);
|
|
||||||
}
|
|
||||||
return -RT_EINVAL;
|
|
||||||
}
|
}
|
||||||
|
|
||||||
/* Configure power mode to normal mode */
|
/* Configure power mode to normal mode */
|
||||||
|
@ -200,13 +198,14 @@ static rt_err_t rt_sensor_open(rt_device_t dev, rt_uint16_t oflag)
|
||||||
sensor->config.power = RT_SENSOR_POWER_NORMAL;
|
sensor->config.power = RT_SENSOR_POWER_NORMAL;
|
||||||
}
|
}
|
||||||
|
|
||||||
|
__exit:
|
||||||
if (sensor->module)
|
if (sensor->module)
|
||||||
{
|
{
|
||||||
/* release the module mutex */
|
/* release the module mutex */
|
||||||
rt_mutex_release(sensor->module->lock);
|
rt_mutex_release(sensor->module->lock);
|
||||||
}
|
}
|
||||||
|
|
||||||
return RT_EOK;
|
return res;
|
||||||
}
|
}
|
||||||
|
|
||||||
static rt_err_t rt_sensor_close(rt_device_t dev)
|
static rt_err_t rt_sensor_close(rt_device_t dev)
|
||||||
|
|
Loading…
Reference in New Issue