diff --git a/libraries/AP_Compass/AP_Compass.cpp b/libraries/AP_Compass/AP_Compass.cpp index 34bfbcca00..6dd0518478 100644 --- a/libraries/AP_Compass/AP_Compass.cpp +++ b/libraries/AP_Compass/AP_Compass.cpp @@ -107,7 +107,7 @@ AP_Compass::calculate(float roll, float pitch) // Magnetic heading heading = atan2(-head_Y, head_X); - ground_course = degrees(heading) + 180; + ground_course = (degrees(heading) + 180) * 100; // Optimization for external DCM use. calculate normalized components heading_X = cos(heading); diff --git a/libraries/AP_Compass/examples/AP_Compass_test/AP_Compass_test.pde b/libraries/AP_Compass/examples/AP_Compass_test/AP_Compass_test.pde index 54776ebb4d..1a69883789 100644 --- a/libraries/AP_Compass/examples/AP_Compass_test/AP_Compass_test.pde +++ b/libraries/AP_Compass/examples/AP_Compass_test/AP_Compass_test.pde @@ -28,13 +28,13 @@ void loop() compass.update(); compass.calculate(0, 0); // roll = 0, pitch = 0 for this example Serial.print("Heading:"); - Serial.print(degrees(compass.heading)); + Serial.print(compass.ground_course,DEC); Serial.print(" ("); Serial.print(compass.mag_X); Serial.print(","); Serial.print(compass.mag_Y); Serial.print(","); Serial.print(compass.mag_Z); - Serial.println(); + Serial.println(" )"); } } \ No newline at end of file