AP_Gimbal: report gimbal angles using a 312 rotation vector

This commit is contained in:
Arthur Benemann 2015-04-08 16:02:13 -07:00 committed by Randy Mackay
parent 2850c7ab4a
commit 21b909f670
1 changed files with 1 additions and 1 deletions

View File

@ -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;
}