Модель Guidance для БПЛА мультиротора
multirotor объект представляет модель руководства уменьшаемого порядка для беспилотного воздушного транспортного средства (UAV). Модель аппроксимирует поведение системы с обратной связью, состоящей из контроллера автопилота и мультиротора кинематическая модель для 3-D движения.
Этот объект требует, чтобы вы установили Библиотеку UAV для Robotics System Toolbox™. Чтобы установить дополнения, используйте roboticsAddons и выберите желаемое дополнение.
Для БПЛА фиксированного крыла смотрите fixedwing.
model = multirotor создает модель движения мультиротора с double значения точности для входных параметров, выходных параметров и параметров конфигурации модели руководства.
model = multirotor(DataType) задает точность типа данных (DataType свойство) для входных параметров, выходных параметров и параметров настроек модели руководства.
control | Управляйте командами для UAV |
derivative | Производная времени состояний UAV |
environment | Экологические входные параметры для UAV |
state | Вектор состояния UAV |
В этом примере показано, как использовать multirotor модель руководства, чтобы симулировать изменение в состоянии UAV из-за ввода команд.
Примечание: Чтобы использовать алгоритмы UAV, необходимо установить Библиотеку UAV для Robotics System Toolbox®. Чтобы установить, используйте roboticsAddons.
Создайте модель руководства мультиротора.
model = multirotor;
Создайте структуру состояния. Задайте местоположение в мировых координатах.
s = state(model); s(1:3) = [3;2;1];
Задайте команду управления, u, это задало список и тягу мультиротора.
u = control(model); u.Roll = pi/12; u.Thrust = 1;
Создайте стандартную среду без ветра.
e = environment(model);
Вычислите производную времени состояния, учитывая текущее состояние, управляйте командой и средой.
sdot = derivative(model,s,u,e);
Симулируйте состояние UAV использование ode45 интегрирование. y поле выводит фиксированное крыло состояния UAV как 13 n матрицей.
simOut = ode45(@(~,x)derivative(model,x,u,e), [0 3], s); size(simOut.y)
ans = 1×2
13 3536
Постройте изменение в углу вращения на основе симуляции выход. Угол вращения (X Углов Эйлера) является 9-й строкой simOut.y вывод .
plot(simOut.y(9,:))
Постройте изменение в Y и положениях Z. С заданной тягой и углом вращения, мультиротор должен пролететь и потерять некоторую высоту. Положительное значение для Z ожидается, когда положительный Z снижается.
figure plot(simOut.y(2,:)); hold on plot(simOut.y(3,:)); legend('Y-position','Z-position') hold off
Можно также построить траекторию мультиротора с помощью plotTransforms. Создайте векторы перевода и вращения из симулированного состояния. Downsample (каждый 300-й элемент) и транспонирует simOut элементы, и преобразуют Углы Эйлера в кватернионы. Задайте mesh как multirotor.stl файл и положительное Z-направление как "down". Отображенное представление показывает перевод UAV в направлении Y и потерю высоты.
translations = simOut.y(1:3,1:300:end)'; % xyz position rotations = eul2quat(simOut.y(7:9,1:300:end)'); % ZYX Euler plotTransforms(translations,rotations,... 'MeshFilePath','multirotor.stl','InertialZDirection',"down") view([90.00 -0.60])
Для мультироторов следующие уравнения используются, чтобы задать модель руководства UAV. Чтобы вычислить производную времени состояния UAV, использующего эти управляющие уравнения, используйте derivative функция. Задайте входные параметры с помощью state, control, и environment.
Положением UAV в наземной системе координат является [xe, ye, ze] с ориентацией как Углы Эйлера ZYX, [ψ, ϴ, ϕ] в радианах. Скоростями вращения является [p, q, r] в радианах в секунду.
Система координат тела UAV использует координаты в качестве [xb, yb, zb].
При преобразовании координат от мира (земля) система координат к системе координат тела UAV матрица вращения:
Because(x), и sin (x) сокращены как cx и sx.
Ускорением центра UAV массы в наземных координатах управляют:
m является массой UAV, g является силой тяжести, и Fthrust является общей силой, созданной пропеллерами, применился к мультиротору вдоль –zb оси (точки вверх в горизонтальном положении).
Контроллер отношения подачи списка с обратной связью аппроксимирует поведение 2 независимых контроллеров PD для этих двух углов поворота и 2 независимых контроллеров P для уровня отклонения от курса и втискивают. Скоростью вращения, угловым ускорением и тягой управляют:
Эта модель принимает, что автопилот берет в списке, которым управляют, подаче, углах отклонения от курса, [ψc, ϴc, ϕc] и общая сила тяги, которой управляют, Fcthrust. Структура, чтобы задать эти входные параметры сгенерирована от control.
Усиления P и D для входных параметров управления заданы как KPα и KDα, где α является или углом поворота или тягой. Эти усиления наряду с массой UAV, m, заданы в Configuration свойство multirotor объект.
От этих управляющих уравнений модель дает следующие переменные: 
Эти переменные совпадают с выходом state функция.
[1] Mellinger, Дэниел и Натан Майкл. "Генерация траектории и Управление для Точных Агрессивных Маневров с Quadrotors". Международный журнал Исследования Робототехники. 2012, стр 664-74.
control | derivative | environment | ode45 | plotTransforms | roboticsAddons | state