?? mat2att.m
字號(hào):
function att = Mat2Att(M)
%姿態(tài)矩陣轉(zhuǎn)化為姿態(tài)角
att = [asin(M(3,2)); atan(-M(3,1)/M(3,3)); atan(M(1,2)/M(2,2))] * 180/pi;
if M(3,3) < 0
%att(2) = att(2) - sign(att(2))*180;
if(att(2) < 0)
att(2) = att(2)+180;
else
att(2) = att(2)-180;
end
end
if( M(2,2) > 0)
if(att(3) < 0)
att(3) = att(3)+360;
end
else
att(3) = att(3)+180;
end
?? 快捷鍵說(shuō)明
復(fù)制代碼
Ctrl + C
搜索代碼
Ctrl + F
全屏模式
F11
切換主題
Ctrl + Shift + D
顯示快捷鍵
?
增大字號(hào)
Ctrl + =
減小字號(hào)
Ctrl + -