Спасибо за редактирование ... забавно, именно это я и сделал. Я взял вектор магнитного севера и повернул его с помощью матрицы вращения вокруг вектора гравитации с изменением между магнитным заголовком и истинным заголовком.
Дело в том, что в этом случае я зависим от магнитного вектора.
В некоторых ситуациях я замечал, что магнитный вектор просто сходил с ума, а датчик выдавал странные значения.
Итак, я хотел получить вектор истинного заголовка, который не зависит от магнитного вектора. Хорошо, что за глупая мысль - скорее всего, истинный курс в любом случае уже зависит от магнитного курса.
Однако - спасибо за ответ:)