analog_sensor.cpp

00001 
00002 #include "udriver.h"
00003 #include "mbed.h"
00004 
00005 int analog_sensor_init(void *obj, void *params)
00006 {
00007     int pin = *(int *)params;
00008     AnalogIn *probe = new AnalogIn((PinName)pin);
00009     *((AnalogIn **)obj) = probe;
00010     
00011     return 0;
00012 }
00013     
00014 
00015 int analog_sensor_read(void *obj, void *data)
00016 {
00017     AnalogIn *probe = *(AnalogIn **)obj;
00018     
00019     *(float *)data = probe->read() * 100;
00020     
00021     return 0;
00022 }
00023 
00024 int analog_sensor_write(void *obj, void *data)
00025 {
00026     return 0;
00027 }
00028 
00029 int analog_sensor_fini(void *obj)
00030 {
00031     AnalogIn *ptr = *(AnalogIn **)obj;
00032     delete ptr;
00033     
00034     return 0;
00035 }
00036 
00037 driver_t analog_sensor_driver = 
00038 {
00039     .init  = analog_sensor_init,
00040     .read  = analog_sensor_read,
00041     .write = analog_sensor_write,
00042     .fini  = analog_sensor_fini,
00043     
00044     .d     = 1,
00045 };