Browse Source

AHRS: removed some debug code

mission-4.1.18
Andrew Tridgell 12 years ago
parent
commit
e282554035
  1. 8
      libraries/AP_AHRS/AP_AHRS.cpp

8
libraries/AP_AHRS/AP_AHRS.cpp

@ -101,18 +101,10 @@ void AP_AHRS::add_trim(float roll_in_radians, float pitch_in_radians)
{ {
Vector3f trim = _trim.get(); Vector3f trim = _trim.get();
// debug -- remove me!
hal.console->printf_P(PSTR("\nadd_trim before R:%4.2f P:%4.2f\n"),
ToDeg(trim.x),ToDeg(trim.y));
// add new trim // add new trim
trim.x = constrain(trim.x + roll_in_radians, ToRad(-10.0), ToRad(10.0)); trim.x = constrain(trim.x + roll_in_radians, ToRad(-10.0), ToRad(10.0));
trim.y = constrain(trim.y + pitch_in_radians, ToRad(-10.0), ToRad(10.0)); trim.y = constrain(trim.y + pitch_in_radians, ToRad(-10.0), ToRad(10.0));
// set and save new trim values // set and save new trim values
_trim.set_and_save(trim); _trim.set_and_save(trim);
// debug -- remove me!
hal.console->printf_P(PSTR("add_trim after R:%4.2f P:%4.2f\n"),
ToDeg(trim.x),ToDeg(trim.y));
} }

Loading…
Cancel
Save