dark0707
/
px4-firmware
forked from Archive/PX4-Autopilot
1
0
Fork 0
Code Pull Requests Activity

lsm303d: Fix memory initialization and error_count not set

This commit is contained in:
Johan Jansen 2015-02-10 16:50:45 +01:00 committed by Lorenz Meier
parent 5fae142bbc
commit c7d0cb6bd7
1 changed files with 2 additions and 0 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

2
src/drivers/lsm303d/lsm303d.cpp
View File

@ -1589,6 +1589,7 @@ LSM303D::mag_measure()
#pragma pack(pop)
mag_report mag_report;
memset(&mag_report, 0, sizeof(mag_report));
/* start the performance counter */
perf_begin(_mag_sample_perf);
@ -1624,6 +1625,7 @@ LSM303D::mag_measure()
mag_report.z = ((mag_report.z_raw * _mag_range_scale) - _mag_scale.z_offset) * _mag_scale.z_scale;
mag_report.scaling = _mag_range_scale;
mag_report.range_ga = (float)_mag_range_ga;
mag_report.error_count = perf_event_count(_bad_registers) + perf_event_count(_bad_values);
// apply user specified rotation
rotate_3f(_rotation, mag_report.x, mag_report.y, mag_report.z);