знание си и умение программировать под линукс и микроконтроллер околонулевые?
1) модуль гпс и камеры пока отлючаете и ложите на полочку. снимаете лопасти, их туда же. отключаете моторы и сервы (у вас же есть сервы для управления наклоном ротора?).
2) к роутеру стм, а к стм аксель и гиро.
3) начинаете с самого начала:
- тренируетесь передавать данные между стм и роутером, роутером и компьютером. сначала просто пару байт поотправлять, потом тренируетесь с сообщениями. "пустое" сообщение, где будет только заголовок с типом сообщения. сообщение с заголовком и одним параметром. ... с n параметрами.
- учитесь обрабатывать данные с акселя и гиро, по ходу вспоминая или изучая что такое матрицы, векторы, углы эйлера и/или кватерионы и как с этим всем работать. отсылаете команду ака сообщение "поехали" с компа на роутер и с роутера на контроллер. обратно с некоторым интнрвалом отсылаете данные с акселя, гиро. так до команды "стоп". усложняете, добавляя фильтр калмана. и т.д., пока не научитесь определять наклоны и движение в пространстве. в итоге после команды "старт" считаете, что тушка верталёта условно находится в координатах 0.0.0 (для начала координаты это не метры или сантиметры, а просто попугаи). берёте тушку и начинаете как-нибудь двигать и вращать, потом ложите на место и отправляете команду "стоп". примерно в 0.0.0? да - чудно, нет - переделать.
- подключаете моторы/сервы и начинаете тренироваться ими управлять.
- надеваете лопасти.
- добавляете различные команды управления. потом усложняете - полетали, а получив команду "вернись в исходную точку" верт должен приземлиться примерно там же где и взлетал.
можете доставать гпс и камеры. алгоритм "для навигации gps" крайне простой: "дай мне координаты" и перевод попугаев в метры/сантиметры путём умножения их на некий коофициент.
а до этого "прекращайте строить здания с крыши".
п.с. я может местами и ошибаюсь в догадках, но ваше "мотор хвостовой начинал крутиться как надо" намекает примерно на такой план действий, как описано выше.
п.п.с. дальномер под брюхом не желаете установить?