Plane: make Plane use milligauss

This commit is contained in:
Staroselskii Georgii 2015-09-04 19:20:35 +03:00 committed by Andrew Tridgell
parent 8bb7e2d4b0
commit db94c8d53d

View File

@ -465,8 +465,8 @@ int8_t Plane::test_mag(uint8_t argc, const Menu::arg *argv)
counter++;
if (counter>20) {
if (compass.healthy()) {
const Vector3f &mag_ofs = compass.get_offsets();
const Vector3f &mag = compass.get_field();
const Vector3f &mag_ofs = compass.get_offsets_milligauss();
const Vector3f &mag = compass.get_field_milligauss();
cliSerial->printf_P(PSTR("Heading: %ld, XYZ: %.0f, %.0f, %.0f,\tXYZoff: %6.2f, %6.2f, %6.2f\n"),
(wrap_360_cd(ToDeg(heading) * 100)) /100,
(double)mag.x, (double)mag.y, (double)mag.z,