крен и тангаж - это термины из авиации, ну их нафик. Будем по-простому. Необходимо найти угол между проекцией вектора магнитного поля на плоскость горизонта и направлением на север. Для этого необходимо знать уравнение плоскости горизонта в координатах LSM303. Исходим из того, что плоскость горизонта нормальна вектору гравитации, ну а дальше, учитывая что система координат магнитного компаса и акселерометра совпадает, все довольно просто. Делал это год назад, пришлось долго вспоминать аналитическую геометрию в пространстве, от туда все и вылазит. в задачнике Клетеника есть примеры задач, от которых нужно плясать
|