Как рассчитать углы, если есть кватернионы? - PullRequest
0 голосов
/ 17 февраля 2020

Я обрабатываю данные с акселерометра и гироскопа с помощью фильтра Махони.
После фильтра у меня есть q0, q1, q2, q3.
Итак, как рассчитать углы в градусах, используя q0, q1, q2, q3 ??

Я использую эти уравнения:

roll = atan2(q0*q1 + q2*q3, 0.5 - q1*q1 - q2*q2)
pitch = asin(-2.0 * (q1*q3 - q0*q2))
yaw = atan2(q1*q2 + q0*q3, 0.5 - q2*q2 - q3*q3)

... но я не получаю правильные углы.

...