Mirror
/
ardupilot
mirror of https://github.com/ArduPilot/ardupilot
5
0
Fork 0
Code Issues Packages Projects Releases Wiki Activity

AP_AHRS: remove debug messages

This commit is contained in:
rmackay9 2012-12-17 23:51:47 +09:00
parent 200389dcc2
commit ee50e63705
1 changed files with 0 additions and 6 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

6
libraries/AP_AHRS/AP_AHRS.cpp
View File

@ -101,16 +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!
Serial.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!
Serial.printf_P(PSTR("add_trim after R:%4.2f P:%4.2f\n"),ToDeg(trim.x),ToDeg(trim.y));
} }