Browse Source

Plane: if SKIP_GYRO_CAL is set the do a gyro cal on 3D accel cal

otherwise the user has no opportunity to do a gyro calibration
master
Andrew Tridgell 10 years ago
parent
commit
b4e01b7936
  1. 5
      ArduPlane/GCS_Mavlink.pde

5
ArduPlane/GCS_Mavlink.pde

@ -1025,6 +1025,11 @@ void GCS_MAVLINK::handleMessage(mavlink_message_t* msg) @@ -1025,6 +1025,11 @@ void GCS_MAVLINK::handleMessage(mavlink_message_t* msg)
else if (packet.param5 == 1) {
float trim_roll, trim_pitch;
AP_InertialSensor_UserInteract_MAVLink interact(chan);
if (g.skip_gyro_cal) {
// start with gyro calibration, otherwise if the user
// has SKIP_GYRO_CAL=1 they don't get to do it
ins.init_gyro();
}
if(ins.calibrate_accel(&interact, trim_roll, trim_pitch)) {
// reset ahrs's trim to suggested values from calibration routine
ahrs.set_trim(Vector3f(trim_roll, trim_pitch, 0));

Loading…
Cancel
Save