2012-05-22 57 views

回答

3

RotMatrix = ř(偏航)* R(间距)* R(辊)

消除偏航因子,我们可以左乘上负偏航矩阵该矩阵

RotMatrixNew = ř(-yaw) * R(偏航)* R(间距)* R(辊)= **- [R *(间距)* R(辊)= ř(间距) * R(辊)

如果偏航角度并不之前已知的,那么它可以被计算为

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