2012-05-22 2 views

Répondre

3

RotMatrix = R (lacet) * R (pitch) * R (roulis)

pour éliminer le facteur de lacet, nous pouvons gauche multiplier cette matrice sur une matrice de lacet négative

RotMatrixNew = R (-yaw) * R (lacet) * R (pitch) * R (roulis) = I **R * (pitch) * R (roulis) = R (pitch) * R (roulis)

Si l'angle de lacet est pas connu avant, alors il pourrait être calculée comme

lacet = arctan2 (RotMatrix [2] [1], RotMatrix [1] [1])

Questions connexes