Mirror/ardupilot
5
0
Fork 0
mirror of https://github.com/ArduPilot/ardupilot synced 2025-01-08 17:08:28 -04:00
Code Issues Packages Projects Releases Wiki Activity

Copter: reset ahrs gyro drift after gyro calibration

Browse Source
This commit is contained in:
Randy Mackay 2014-10-28 20:23:18 +09:00
parent 95538d2992
commit 7b4cd9ee37
2 changed files with 7 additions and 0 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

2
ArduCopter/GCS_Mavlink.pde
View File

@ -1113,6 +1113,8 @@ void GCS_MAVLINK::handleMessage(mavlink_message_t* msg)
if (packet.param1 == 1) { if (packet.param1 == 1) {
// gyro offset calibration // gyro offset calibration
ins.init_gyro(); ins.init_gyro();
// reset ahrs gyro bias
ahrs.reset_gyro_drift();
result = MAV_RESULT_ACCEPTED; result = MAV_RESULT_ACCEPTED;
} }
if (packet.param3 == 1) { if (packet.param3 == 1) {

5
ArduCopter/system.pde
View File

@ -320,6 +320,11 @@ static void startup_ground(bool force_gyro_cal)
report_ins(); report_ins();
#endif #endif
// reset ahrs gyro bias
if (force_gyro_cal) {
ahrs.reset_gyro_drift();
}
// setup fast AHRS gains to get right attitude // setup fast AHRS gains to get right attitude
ahrs.set_fast_gains(true); ahrs.set_fast_gains(true);