Я делаю свой квадрокоптер. Часть 1. Уравнения динамики

в 7:31, , рубрики: diy или сделай сам, динамика, квадрокоптер, Программинг микроконтроллеров, Электроника для начинающих, метки: , ,

Оглавление

1. Уравнения динамики

Введение

Я делаю свой квадрокоптер. Часть 1. Уравнения динамики

Давным-давно я написал следующий комментарий: Всё.
После такой новости сажусь делать свой квадрокоптер. А то вон все делают, а я нет.
Не, ну а что.
Всегда хотел, чтобы у меня была какая-нибудь летающая штука. Были 2 вертолета радиоуправляемых. Но кончилось это плохо.
Я решил делать свой квадрокоптер. Как это кончится — посмотрим. Я не буду использовать какие-либо готовые полетные контроллеры, все запрограммирую самостоятельно. И постараюсь этот процесс описать в цикле статей. Сейчас представляю вашему вниманию первую часть. В ней будет бегло показано то, какие уравнения динамики скрываются внутри квадрокоптера.
Итак, поехали.

1. Вывод уравнений движения

Я делаю свой квадрокоптер. Часть 1. Уравнения динамики
Ориентация квадрокоптера в пространстве задается тремя углами: рысканья — ψ, тангажа — θ, крена — φ.
Они вместе составляют вектор
Я делаю свой квадрокоптер. Часть 1. Уравнения динамики.
Позиция устройства в инерциальной система отсчета задается радиус-вектором
Я делаю свой квадрокоптер. Часть 1. Уравнения динамики.
Матрица перехода из системы координат квадрокоптера в инерциальную систему координат имеет следующий вид
Я делаю свой квадрокоптер. Часть 1. Уравнения динамики
Сила тяги, производимая каждым из четырех двигателей равна
Я делаю свой квадрокоптер. Часть 1. Уравнения динамики
Здесь ωi− угловая скорость двигателя, а b – коэффициент пропорциональности.
Теперь мы можем записать дифференциальное уравнение, описывающее ускорение квадрокоптера по вертикальной оси.
Я делаю свой квадрокоптер. Часть 1. Уравнения динамики
Сразу же запишем второе дифференциальное уравнение
Я делаю свой квадрокоптер. Часть 1. Уравнения динамики
Здесь I – матрица инерции, M – вращающий момент, приложенный к квадрокоптеру, MG– гироскопический момент.
Вектор M задается следующим образом:
Я делаю свой квадрокоптер. Часть 1. Уравнения динамики
Здесь d — коэффициент лобового сопротивления, L – длина плеча.
Гироскопические моменты, вызванные поворотом объекта с вращающимися роторами двигателей записываются так:
Я делаю свой квадрокоптер. Часть 1. Уравнения динамики

Введем 4 сигнала управления, которые будут управлять квадрокоптером:
Я делаю свой квадрокоптер. Часть 1. Уравнения динамики
Я делаю свой квадрокоптер. Часть 1. Уравнения динамики
Я делаю свой квадрокоптер. Часть 1. Уравнения динамики
Я делаю свой квадрокоптер. Часть 1. Уравнения динамики

Гироскопические моменты, действующие на квадрокоптер, зависят от угловых скоростей роторов двигателей и, следовательно, от вектора управления
Я делаю свой квадрокоптер. Часть 1. Уравнения динамики

Запишем систему уравнений, описывающих нашу систему.
Я делаю свой квадрокоптер. Часть 1. Уравнения динамики

И теперь преобразуем систему таким образом, чтобы не было вторых производных.
Я делаю свой квадрокоптер. Часть 1. Уравнения динамики

Эта система из 9 уравнений как раз и описывает динамику системы.

Заключение

Пост получился несколько некрасивым.
Подскажите, пожалуйста, он-лайн редактор формул? А то эти совсем отвратно смотрятся.

Во второй части я расскажу о том, как сделать модель в Matlab, которая будет описывать систему стабилизации нашего будущего квадрокоптера.
Вопросы-предложения приветствуются!

Автор: argz

Источник

Поделиться

* - обязательные к заполнению поля