В современных системах управления стабильность является краеугольным камнем безопасной и предсказуемой работы. Нигде это не проявляется более очевидно, чем в квадроторных дронах, где нестабильность может привести к катастрофическому сбою в течение нескольких секунд. Данное тематическое исследование демонстрирует практическое применение критерия Рут-Гурвиц для анализа и стабилизации системы управления квадроторным дроном. Сконструировав массив Рут из характерного полинома системы замкнутого цикла, инженеры могут определять стабильность без решения для корней напрямую, обеспечивая быструю настройку параметров и надежные летные характеристики.

Квадроторная динамика и архитектура управления

Квадротор представляет собой недостаточно сцепленную, сильно связанную нелинейную систему. Его движение контролируется изменением скоростей четырех роторов, которые генерируют тягу и крутящий момент. Для анализа устойчивости система обычно линеаризуется вокруг состояния наведения, давая набор разъединенных дифференциальных уравнений второго порядка для крена, шага, рыскания и высоты. Система управления обычно использует контроллеры пропорционального-интегрального-производного (PID) для каждой оси, с замкнутыми вокруг установки петлями обратной связи и измерениями угловой скорости из инерциального измерительного блока (IMU). Функция передачи замкнутого цикла каждой оси может быть получена, что приводит к характерному полиному, корни которого определяют стабильность.

Линейная модель для Roll Axis

Рассмотрим динамику крена. Линеаризованное уравнение движения:

где угол крена, момент инерции, является производным аэродинамического демпфирования, и является производным управления, представляющим крутящий момент, создаваемый дифференциальной тягой.

Замена и формирование функции передачи замкнутого цикла дает характерный многочлен порядка три (или выше, если включить динамику датчика).

Критерий Рут-Гурвица позволяет анализировать знак реальных частей корней без явного нахождения корней.

Критерий Рут-Гурвица: систематический тест на стабильность

Разработанный независимо Эдвардом Джоном Рутом и Адольфом Гурвицом критерий Рут — Гурвиц обеспечивает необходимое и достаточное условие устойчивости линейных временных инвариантных систем. Он использует коэффициенты характеристического многочлена для построения массива (решетки Рут). Число знаковых изменений в первом столбце этого массива равно числу корней с положительными реальными частями. Для того чтобы система была стабильной, все записи в первом столбце должны иметь один и тот же знак (обычно положительный).

Построение решетки Routh Array

Если же он будет многочленным, то он будет построен из множества, состоящего из множества, состоящего из множества, состоящего из множества, состоящего из множества, состоящего из множества, состоящего из множества, состоящего из множества, состоящего из множества, состоящего из множества, состоящего из множества, состоящего из множества, состоящего из множества, состоящего из множества.

  • Row 1: — коэффициенты равноиндексированных терминов.
  • Row 2: — коэффициенты нечетных индексов.
  • Последующие строки вычисляются по формуле: (где a1 является первым элементом второй строки).

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

Условия стабильности для систем третьего порядка

Для кубического многочлена условия Рута-Гурвица упрощают:

  • Все коэффициенты должны быть положительными (необходимое условие).
  • Неравенство должно сохраняться (достаточное условие для третьего порядка).

Это простое правило часто используется в качестве быстрой проверки перед построением полного массива.

Применение системы управления квадротором

Для нашего квадроторного кейса характерный полином для оси крена, включая коэффициент усиления контроллера PID и динамику ротора (моделируемую как лаг первого порядка с постоянной времени τ), был получен как:

Если числовые значения физической системы составляют: τ = 0,05 с (постоянная времени вращения ротора), I xx = 0,01 кг·м2, L 2 = 0,5 Н·м на единицу управления. Начальные коэффициенты PID были выбраны на основе эвристической настройки: K p = 10, K i = 2, K d = 5.

→

Построение Routh Array

Мы создаем массив для этого полинома четвертого порядка:

  • 1 (s4): 0,05, 15.1, 10
  • Ряд 2 (s3): 1,5, 52, 0
  • Ряд 3 (s2): вычислить b1 = (1.5*15.1 - 0.05*52)/1.5 = (22.65 - 2.6)/1.5 = 13.367; b2 = (1.5*10 - 0.05*0)/1.5 = 10; b3 = 0
  • 4 (s1): c1 = (13.367*52 - 1.5*10)/13.367 = (694.064 - 15)/13.367 = 50.84; c2 = 0
  • 5 (s0): d1 = (50,84*10 - 13,367*0)/50,84 = 10

Первые значения столбца: 0,05, 1,5, 13,367, 50,84, 10 – все положительно, никаких знаковых изменений. Таким образом, система с этими усилениями стабильна. Однако, если мы увеличим интегральный коэффициент усиления до K i = 20, то полиномиальные коэффициенты изменятся и массив Рута выявит изменение знака, указывающее на нестабильность. Это демонстрирует мощность критерия для параметра исследования космоса.

Настройка параметров с использованием ограничений Routh-Hurwitz

Вместо моделирования проб и ошибок критерий Рут-Гурвица обеспечивает алгебраические неравенства, которые должны быть удовлетворены для стабильности. Для полученного нами полинома четвертого порядка необходимыми условиями являются:

  • Все коэффициенты положительные: автоматически удовлетворяются, если выигрыши положительные и τ > 0.
  • Первый столбец массива Рут не должен иметь никаких изменений знака.

Выражая первые столбцы символично в терминах K p, K i и K d, мы получили три уравнения ограничения. Решая эти неравенства, определяется стабильная область в пространстве усиления. Для нашего квадротора была обнаружена стабильная область:

  • (приблизительно от состояния Рута)

Эти ограничения определяли выбор конечных результатов: K p = 8, K i = 1, K d = 4, которые лежат в пределах стабильной области и обеспечивают хороший запас фаз при оценке с помощью частотной реакции.

Результаты моделирования и валидации

Нелинейное моделирование квадротора в среде Gazebo использовалось для проверки пределов стабильности. При оптимизированном Рутом-Гурвицом приросте отклик крена на вход шага 10 градусов показал время оседания 0,8 секунды, превышение менее 5% и отсутствие ошибки устойчивого состояния. Напротив, прирост за пределами стабильной области (например, K i = 20) вызывал дивергентные колебания, которые росли неограниченными в течение 2 секунд.

Дальнейшие испытания на прочность включали порывы ветра до 5 м/с и шум датчика, типичный для недорогих ИДУ МЭМС. Контроллер поддерживал стабильность во всех случаях, при этом максимальное отклонение угла крена оставалось ниже 1,5 градусов. Таким образом, критерий Рут-Гурвица обеспечивал не только стабильность, но и исходную линию для надежной производительности.

Практические соображения по осуществлению

Хотя критерий Рут-Гурвица является мощным аналитическим инструментом, он имеет ограничения. Он применяется только к линейным системам с инвариантным временем, поэтому линеаризованная модель должна быть действительна вокруг рабочей точки. Для агрессивных маневров нелинейные эффекты (например, насыщение привода, гироскопический крутящий момент) могут вызывать деградацию стабильности. Инженеры должны дополнять анализ Рут-Гурвица симуляциями временной области и методами частотной области (такими как участки Боде или корневой локус).

Кроме того, цифровая реализация вводит задержки выборки и ошибки квантования. Их можно смоделировать как дополнительное фазовое отставание, что снижает эффективный фазовый запас. Критерий все же можно применить, включив цифровую задержку управления в качестве дополнительного полюса в характерный полином. Для нашего квадротора, работающего по петле управления на 500 Гц, задержка сохранялась ниже 2 мс, что не сильно изменило результаты массива Рута.

Заключение

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

Для дальнейшего чтения по критерию Рут-Хурвица см. всеобъемлющая статья Википедии. Отличная ссылка на динамику квадротора — статья Б. Корка в Робототехника и автономные системы. Для более глубокой теории управления обратитесь к Учебникам по контролю Мичиганского университета для MATLAB. Используемая среда моделирования может быть найдена на официальном сайте Pixhawk.