2012-05-22 135 views

回答

3

RotMatrix = ř(偏航)* R(間距)* R(輥)

消除偏航因子,我們可以左乘上負偏航矩陣該矩陣

RotMatrixNew = ř(-yaw) * R(偏航)* R(間距)* R(輥)= **- [R *(間距)* R(輥)= ř(間距) * R(輥)

如果偏航角度並不之前已知的,那麼它可以被計算爲

偏航= ArcTan2(RotMatrix [2] [1],RotMatrix [1] [1])