aepko/Ardupilot2
1
0
Fork 0
Code Issues Pull Requests Actions Packages Projects Releases Wiki Activity

Copter: support pre-flight calibration of gyro

Browse Source
This commit is contained in:
Randy Mackay 2014-10-08 20:19:18 +09:00
parent 9a0a83f404
commit a8733ae8a8
1 changed files with 3 additions and 4 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

7
ArduCopter/GCS_Mavlink.pde
View File

@ -1100,10 +1100,9 @@ void GCS_MAVLINK::handleMessage(mavlink_message_t* msg)
break; break;
case MAV_CMD_PREFLIGHT_CALIBRATION: case MAV_CMD_PREFLIGHT_CALIBRATION:
if (packet.param1 == 1 || if (packet.param1 == 1) {
packet.param2 == 1) { // gyro offset calibration
ins.init_accel(); ins.init_gyro();
ahrs.set_trim(Vector3f(0,0,0)); // clear out saved trim
result = MAV_RESULT_ACCEPTED; result = MAV_RESULT_ACCEPTED;
} }
if (packet.param3 == 1) { if (packet.param3 == 1) {