Browse Source

AP_Gimbal: report gimbal angles using a 312 rotation vector

mission-4.1.18
Arthur Benemann 10 years ago committed by Randy Mackay
parent
commit
21b909f670
  1. 2
      libraries/AP_Mount/AP_Gimbal.cpp

2
libraries/AP_Mount/AP_Gimbal.cpp

@ -180,7 +180,7 @@ void AP_Gimbal::update_target(Vector3f newTarget) @@ -180,7 +180,7 @@ void AP_Gimbal::update_target(Vector3f newTarget)
Vector3f AP_Gimbal::getGimbalEstimateEF()
{
Quaternion quatEst;_ekf.getQuat(quatEst);Vector3f eulerEst;quatEst.to_euler(eulerEst.x, eulerEst.y, eulerEst.z);
Quaternion quatEst;_ekf.getQuat(quatEst);Vector3f eulerEst;quatEst.to_vector312(eulerEst.x, eulerEst.y, eulerEst.z);
return eulerEst;
}

Loading…
Cancel
Save