granit201zМне кажется (сужу по себе) что участники продолжают непонимать чего вы хотите.
Я понял так. Допустим, зафиксирована какая-то неподвижная относительно земли прямоугольная система координат в которой к примеру ось
вертикальна, ось
направлена на восток а ось
на север. Так что вектор
коллинеарен оси
Допустим, с датчиков поступает инфа о направлении вектора
относительно осей связанных с датчиками, допустим ось
направлена перпендикулярно последней пластинке на вашей картинке, ось
направлена коллинеарно оси вращения третьего серва, а ось
направлена перпендикулярно
и перпендикулярно
То есть с датчиков поступают значения проекций (с учетом знака ессно) вектора
на оси
,
и
, а именно
Вы хотите узнать, как должны измениться показания датчиков (
) если сервомоторы повернутся на известные вам углы.
Здесь мне кажется, что по крайней мере имеется такая проблема: если
коллинеарен какой-либо из осей, то нужен ещё компас.