diff options
author | Lorenz Meier <lm@inf.ethz.ch> | 2014-03-17 16:53:30 +0100 |
---|---|---|
committer | Lorenz Meier <lm@inf.ethz.ch> | 2014-03-17 16:53:30 +0100 |
commit | fd8cae19bdb4ba5e97c810f266f78af1461b51b7 (patch) | |
tree | 88b869aa15af8d2709d3eef05661e82c5c079f25 /src/modules/sensors/sensors.cpp | |
parent | 7be1c400f99b4cc3df7ee7cc738d88f85e58cb48 (diff) | |
download | px4-firmware-fd8cae19bdb4ba5e97c810f266f78af1461b51b7.tar.gz px4-firmware-fd8cae19bdb4ba5e97c810f266f78af1461b51b7.tar.bz2 px4-firmware-fd8cae19bdb4ba5e97c810f266f78af1461b51b7.zip |
ADC channel mapping fix in sensors app
Diffstat (limited to 'src/modules/sensors/sensors.cpp')
-rw-r--r-- | src/modules/sensors/sensors.cpp | 11 |
1 files changed, 7 insertions, 4 deletions
diff --git a/src/modules/sensors/sensors.cpp b/src/modules/sensors/sensors.cpp index b176d7417..6560dec3d 100644 --- a/src/modules/sensors/sensors.cpp +++ b/src/modules/sensors/sensors.cpp @@ -1169,16 +1169,19 @@ Sensors::adc_poll(struct sensor_combined_s &raw) hrt_abstime t = hrt_absolute_time(); /* rate limit to 100 Hz */ if (t - _last_adc >= 10000) { - /* make space for a maximum of eight channels */ - struct adc_msg_s buf_adc[8]; + /* make space for a maximum of ten channels (to ensure reading all channels at once) */ + struct adc_msg_s buf_adc[10]; /* read all channels available */ int ret = read(_fd_adc, &buf_adc, sizeof(buf_adc)); if (ret >= (int)sizeof(buf_adc[0])) { - for (unsigned i = 0; i < sizeof(buf_adc) / sizeof(buf_adc[0]); i++) { + + /* Read add channels we got */ + for (unsigned i = 0; i < ret / sizeof(buf_adc[0]); i++) { /* Save raw voltage values */ - if (i < (sizeof(raw.adc_voltage_v)) / sizeof(raw.adc_voltage_v[0])) { + if (i < (sizeof(raw.adc_voltage_v) / sizeof(raw.adc_voltage_v[0]))) { raw.adc_voltage_v[i] = buf_adc[i].am_data / (4096.0f / 3.3f); + raw.adc_mapping[i] = buf_adc[i].am_channel; } /* look for specific channels and process the raw voltage to measurement data */ |