diff options
author | pixhawk <pixhawk@pixhawk01.(none)> | 2012-08-20 16:08:27 +0200 |
---|---|---|
committer | pixhawk <pixhawk@pixhawk01.(none)> | 2012-08-20 16:08:27 +0200 |
commit | 801697c5402dad7b2949105e7a4ee02a21f7846a (patch) | |
tree | b0513481c01dd916b5531769aac81df9065648ef /apps/sensors | |
parent | 78db6c990b609a773b2bb1eb0e1d979e77933ced (diff) | |
download | px4-firmware-801697c5402dad7b2949105e7a4ee02a21f7846a.tar.gz px4-firmware-801697c5402dad7b2949105e7a4ee02a21f7846a.tar.bz2 px4-firmware-801697c5402dad7b2949105e7a4ee02a21f7846a.zip |
fixed sensors error printing
Diffstat (limited to 'apps/sensors')
-rw-r--r-- | apps/sensors/sensors.c | 5 |
1 files changed, 3 insertions, 2 deletions
diff --git a/apps/sensors/sensors.c b/apps/sensors/sensors.c index 6a06a786f..ef8ff798f 100644 --- a/apps/sensors/sensors.c +++ b/apps/sensors/sensors.c @@ -514,6 +514,7 @@ int sensors_thread_main(int argc, char *argv[]) mag_offset[1] = global_data_parameter_storage->pm.param_values[PARAM_SENSOR_MAG_YOFFSET]; mag_offset[2] = global_data_parameter_storage->pm.param_values[PARAM_SENSOR_MAG_ZOFFSET]; + paramcounter = 0; } @@ -565,7 +566,7 @@ int sensors_thread_main(int argc, char *argv[]) if (ret_accelerometer != sizeof(buf_accelerometer)) { acc_fail_count++; - if (acc_fail_count & 0b1000 || (acc_fail_count > 20 && acc_fail_count < 100)) { + if (acc_fail_count & 0b111 || (acc_fail_count > 20 && acc_fail_count < 100)) { fprintf(stderr, "[sensors] BMA180 ERROR #%d: %s\n", (int)*get_errno_ptr(), strerror((int)*get_errno_ptr())); } @@ -618,7 +619,7 @@ int sensors_thread_main(int argc, char *argv[]) if (ret_magnetometer != sizeof(buf_magnetometer)) { mag_fail_count++; - if (mag_fail_count & 0b1000 || (mag_fail_count > 20 && mag_fail_count < 100)) { + if (mag_fail_count & 0b111 || (mag_fail_count > 20 && mag_fail_count < 100)) { fprintf(stderr, "[sensors] HMC5883L ERROR #%d: %s\n", (int)*get_errno_ptr(), strerror((int)*get_errno_ptr())); } |