diff options
Diffstat (limited to 'components/drivers/sensors/sensor.cpp')
| -rw-r--r-- | components/drivers/sensors/sensor.cpp | 232 |
1 files changed, 232 insertions, 0 deletions
diff --git a/components/drivers/sensors/sensor.cpp b/components/drivers/sensors/sensor.cpp new file mode 100644 index 0000000000..18eb8eee18 --- /dev/null +++ b/components/drivers/sensors/sensor.cpp @@ -0,0 +1,232 @@ +/* + * File : sensors.cpp + * This file is part of RT-Thread RTOS + * COPYRIGHT (C) 2014, RT-Thread Development Team + * + * The license and distribution terms for this file may be + * found in the file LICENSE in this distribution or at + * http://www.rt-thread.org/license/LICENSE + * + * Change Logs: + * Date Author Notes + * 2014-08-03 Bernard the first version + */ + +#include <stddef.h> +#include <string.h> + +#include "sensor.h" + +/** + * SensorBase + */ +SensorBase::SensorBase(int type) +{ + memset(&(this->config), 0x0, sizeof(SensorConfig)); + + this->type = type; + this->next = this->prev = NULL; + subscribe(NULL, NULL); +} + +SensorBase::~SensorBase() +{ +} + +int SensorBase::getType(void) +{ + return this->type; +} + +int SensorBase::setConfig(SensorConfig *config) +{ + int result; + + /* configure to the low level sensor */ + result = this->configure(config); + if (result == 0) + { + this->config = *config; + } + + return result; +} + +int SensorBase::getConfig(SensorConfig *config) +{ + *config = this->config; + return 0; +} + +int SensorBase::subscribe(SensorEventHandler_t *handler, void *user_data) +{ + this->evtHandler = handler; + this->userData = user_data; + + return 0; +} + +int SensorBase::publish(sensors_event_t *event) +{ + if (this->evtHandler != NULL) + { + /* invoke subscribed handler */ + (*evtHandler)(event, this->userData); + } + + return 0; +} + +/** + * Sensor Manager + */ +/* sensors list */ +static SensorBase *sensor_list = NULL; + +SensorManager::SensorManager() +{ +} + +SensorManager::~SensorManager() +{ +} + +int SensorManager::registerSensor(SensorBase *sensor) +{ + RT_ASSERT(sensor != RT_NULL); + + /* add sensor into the list */ + if (sensor_list == NULL) + { + sensor->prev = sensor->next = sensor; + } + else + { + sensor_list->prev->next = sensor; + sensor->prev = sensor_list->prev; + + sensor_list->prev = sensor; + sensor->next = sensor_list; + } + + /* point the sensorList to this sensor */ + sensor_list = sensor; + + return 0; +} + +int SensorManager::unregisterSensor(SensorBase *sensor) +{ + /* disconnect sensor list */ + sensor->next->prev = sensor->prev; + sensor->prev->next = sensor->next; + + /* check the sensorList */ + if (sensor == sensor_list) + { + if (sensor->next == sensor) sensor_list = NULL; /* empty list */ + else sensor_list = sensor->next; + } + + /* re-initialize sensor node */ + sensor->next = sensor->prev = sensor; + + return 0; +} + +SensorBase *SensorManager::getDefaultSensor(int type) +{ + SensorBase *sensor = sensor_list; + + if (sensor == NULL) return NULL; + + do + { + /* find the same type */ + if (sensor->getType() == type) return sensor; + + sensor = sensor->next; + }while (sensor != sensor_list); + + return NULL; +} + +int SensorManager::subscribe(int type, SensorEventHandler_t *handler, void *user_data) +{ + SensorBase *sensor; + + sensor = SensorManager::getDefaultSensor(type); + if (sensor != NULL) + { + sensor->subscribe(handler, user_data); + return 0; + } + + return -1; +} + +int SensorManager::sensorEventReady(SensorBase *sensor) +{ + return 0; +} + +int SensorManager::pollSensor(SensorBase *sensor, sensors_event_t *events, int number, int duration) +{ + rt_tick_t tick; + int result, index; + + if (sensor == NULL) return -1; + + tick = rt_tick_get(); + for (index = 0; index < number; index ++) + { + result = sensor->poll(&events[index]); + if (result < 0) break; + + if (rt_tick_get() - tick > duration) break; + } + + return index; +} + +rt_sensor_t rt_sensor_get_default(int type) +{ + return (rt_sensor_t)SensorManager::getDefaultSensor(type); +} + +int rt_sensor_subscribe(rt_sensor_t sensor, SensorEventHandler_t *handler, void *user_data) +{ + SensorBase *sensor_base; + if (sensor == NULL) return -1; + + sensor_base = (SensorBase*)sensor; + + return sensor_base->subscribe(handler, user_data); +} + +int rt_sensor_poll(rt_sensor_t sensor, sensors_event_t *event) +{ + SensorBase *sensor_base; + if (sensor == NULL || event == NULL) return -1; + + sensor_base = (SensorBase*)sensor; + return sensor_base->poll(event); +} + +int rt_sensor_configure(rt_sensor_t sensor, SensorConfig *config) +{ + SensorBase *sensor_base; + if (sensor == NULL || config == NULL) return -1; + + sensor_base = (SensorBase*)sensor; + return sensor_base->setConfig(config); +} + +int rt_sensor_activate(rt_sensor_t sensor, int enable) +{ + SensorBase *sensor_base; + if (sensor == NULL) return -1; + + sensor_base = (SensorBase*)sensor; + return sensor_base->activate(enable); +} |
