mirror of
https://github.com/PX4/PX4-Autopilot.git
synced 2026-05-28 19:32:36 +08:00
lsm303d: Fix memory initialization and error_count not set
This commit is contained in:
committed by
Lorenz Meier
parent
5fae142bbc
commit
c7d0cb6bd7
@@ -1589,6 +1589,7 @@ LSM303D::mag_measure()
|
|||||||
#pragma pack(pop)
|
#pragma pack(pop)
|
||||||
|
|
||||||
mag_report mag_report;
|
mag_report mag_report;
|
||||||
|
memset(&mag_report, 0, sizeof(mag_report));
|
||||||
|
|
||||||
/* start the performance counter */
|
/* start the performance counter */
|
||||||
perf_begin(_mag_sample_perf);
|
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.z = ((mag_report.z_raw * _mag_range_scale) - _mag_scale.z_offset) * _mag_scale.z_scale;
|
||||||
mag_report.scaling = _mag_range_scale;
|
mag_report.scaling = _mag_range_scale;
|
||||||
mag_report.range_ga = (float)_mag_range_ga;
|
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
|
// apply user specified rotation
|
||||||
rotate_3f(_rotation, mag_report.x, mag_report.y, mag_report.z);
|
rotate_3f(_rotation, mag_report.x, mag_report.y, mag_report.z);
|
||||||
|
|||||||
Reference in New Issue
Block a user