2025-11-12T03:49:09.545098

Trajectory control of a suspended load with non-stopping flying carriers

Girardello, Michieletto, Cenedese et al.
This paper presents the first closed-loop control framework for cooperative payload transportation with non-stopping flying carriers. Building upon grasp-matrix formulations and internal force redundancy, we propose a feedback wrench controller that actively regulates the payload's pose while an optimization layer dynamically shapes internal-force oscillations to guarantee persistent carrier motion. Preliminary experimental results on multirotor UAVs validate the model assumptions, and numerical simulations demonstrate that the method successfully prevents carrier stagnation, achieves accurate load tracking, and generates physically feasible trajectories with smooth velocity profiles. The proposed framework not only advances the state of the art but also offers a reliable, versatile solution for future real-world applications requiring load transportation by coordinated non-stopping flying carriers.
academic

Управление траекторией подвешенного груза с непрерывно летающими носителями

Основная информация

  • ID статьи: 2510.11413
  • Название: Trajectory control of a suspended load with non-stopping flying carriers
  • Авторы: София Джирарделло, Джулия Микелетто, Анджело Ченедезе, Антонио Франки, Кьяра Габеллиери
  • Классификация: eess.SY cs.SY (Системы и управление)
  • Дата публикации: 13 октября 2025 г. (препринт arXiv)
  • Ссылка на статью: https://arxiv.org/abs/2510.11413

Аннотация

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

Исследовательский контекст и мотивация

Исследуемая проблема

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

Значимость проблемы

  1. Практические потребности: Срочная необходимость в транспортировке грузов для дальних логистических операций, гуманитарной помощи, инспекции инфраструктуры и строительства
  2. Технические вызовы: Беспилотные летательные аппараты с неподвижным крылом обладают лучшей дальностью и автономностью по сравнению с многороторными, но должны поддерживать положительную скорость для сохранения полёта
  3. Практическое значение: Обеспечение теоретической базы и технических решений для будущих крупномасштабных и дальних кооперативных воздушных операций

Ограничения существующих методов

  1. Ограничения многороторных систем: Существующие исследования сосредоточены в основном на многороторных беспилотниках с ограниченной автономностью и диапазоном операций
  2. Разомкнутое управление: Существующие исследования непрерывно летающих носителей ограничиваются только разомкнутым планированием траектории без обратной связи
  3. Статические грузы: Существующие методы рассматривают только статическое равновесие груза без поддержки динамического отслеживания траектории

Основные вклады

  1. Первая система замкнутого управления: Предложена первая замкнутая система управления для кооперативной транспортировки груза непрерывно летающими носителями
  2. Динамическое отслеживание траектории: Расширение существующей теории с поддержкой динамического отслеживания траектории груза, а не только статического равновесия
  3. Стратегия онлайн-оптимизации: Разработан алгоритм оптимизации в реальном времени для динамической регулировки параметров внутренних сил с целью обеспечения ограничений скорости носителей
  4. Теоретическая и экспериментальная верификация: Подтверждение эффективности метода посредством численного моделирования и предварительных экспериментов

Подробное описание методологии

Определение задачи

Входные данные: Желаемая траектория груза pLd(t)∈R3p_{Ld}(t) \in \mathbb{R}^3, RLd(t)∈SO(3)R_{Ld}(t) \in SO(3) и соответствующие скорости Выходные данные: Траектория натяжения кабелей {fi(t)}i=1n\{f_i(t)\}_{i=1}^n и траектории носителей {pRi(t)}i=1n\{p_{R_i}(t)\}_{i=1}^nОграничения:

  1. Асимптотическая устойчивость ошибки отслеживания груза
  2. Ограничение скорости носителя: ∥p˙Ri(t)∥≥ε>0\|\dot{p}_{R_i}(t)\| \geq \varepsilon > 0, ∀i=1,...,n\forall i = 1,...,n

Архитектура модели

1. Моделирование системы

Система состоит из n≥3n \geq 3 непрерывно летающих носителей, каждый соединён с общим жёстким грузом кабелем. Ключевые кинематические соотношения:

pRi=pL+RLBbi+Liqi,i=1,...,np_{R_i} = p_L + R_L {}^B b_i + L_i q_i, \quad i = 1,...,n

где qi∈S2q_i \in S^2 — единичный вектор направления от груза к носителю.

2. Представление матрицы захвата

Связь между силами кабелей и моментом груза описывается матрицей захвата:

w=G(RL)fw = G(R_L)f

где G(RL)∈R6×3nG(R_L) \in \mathbb{R}^{6 \times 3n} — матрица захвата:

I_3 & \cdots & I_3 \\ S({}^B b_1)R_L^T & \cdots & S({}^B b_n)R_L^T \end{bmatrix}$$ #### 3. Трёхуровневая архитектура управления **Внешний контур контроллера момента груза**: ``` fd = -Kp ep - Kv ev - Ki ∫₀ᵗ ep(τ)dτ + mL ge₃ τd = -KR eR - Kω eω - KiR ∫₀ᵗ eR(τ)dτ + ωL × (JL ωL) ``` **Внутренний контур генерации траектории носителя**: $$f_d(t) = G(R_L(t))^† w_d(t) + N(R_L(t))λ(t)$$ **Оптимизационный слой**: Динамическая регулировка параметров внутренних сил $λ(t)$ для удовлетворения ограничений скорости. ### Технические инновации #### 1. Обработка нестационарной матрицы захвата В отличие от существующих методов для статических грузов, данная работа учитывает нестационарную матрицу захвата $G(t)$ и нулевое пространство $N(t)$, вызванные изменением ориентации груза. #### 2. Математическая характеризация ограничения скорости носителя Выведено явное выражение для скорости носителя: $$\dot{p}_{R_i}(t) = v_{L_i}(t) + \frac{L_i}{T_i(t)}(E_i(t) + G_i(t))$$ где $E_i(t)$ — внешний вклад, $G_i(t)$ — вклад внутренних сил. Ограничение непрерывного полёта эквивалентно: $$0 \notin V_i := \{\dot{p}_{R_i}(t) : t \geq 0\}$$ #### 3. Алгоритм онлайн-оптимизации Определена задача оптимизации: $$x^* = \arg\min_{x \in \mathbb{R}^2} J(x)$$ при ограничениях: $\|v_{L_i}(t) + \frac{L_i}{T_i}\Pi_i(t)(\dot{G}^†_i w_d + G^†_i \dot{w}_d + \dot{N}_i λ + N_i \dot{λ})\|^2 \geq \varepsilon$ Целевая функция включает штрафные члены за гладкость и непрерывность. ## Экспериментальная установка ### Экспериментальная платформа 1. **Эксперименты по верификации модели**: 3 квадрокоптера Crazyflie 2.1 с использованием программного обеспечения Crazyswarm и внешней системы захвата движения 2. **Численное моделирование**: Система с 4 носителями с учётом полной динамики груза и кабелей, включая упругость кабелей и другие неидеальные факторы ### Спецификации груза - **Экспериментальный груз**: Треугольный груз из углеродного волокна со стороной 0,515 м и массой 0,012 кг - **Длина кабеля**: Примерно 1 м хлопчатобумажной нити - **Груз в моделировании**: Масса 1,0 кг, тензор инерции 0,01I₃ кг·м² ### Проектирование траектории В моделировании использована комбинированная траектория: начальный покой → линейное движение вдоль оси x → финальный покой, специально разработанная для тестирования поведения носителей при изменении скорости груза. ### Показатели оценки 1. **Точность отслеживания груза**: Ошибка положения $e_p$ и ошибка ориентации $e_R$ 2. **Ограничение скорости носителя**: $\|\dot{p}_{R_i}\| \geq \varepsilon = 0,2$ м/с 3. **Гладкость траектории**: Непрерывность профиля скорости ## Результаты экспериментов ### Результаты верификации модели Предварительные эксперименты (рис. 3) подтвердили: 1. **Точность отслеживания траектории**: Многороторные беспилотники точно отслеживают эллиптическую опорную траекторию 2. **Стабильность груза**: Ориентация груза остаётся стабильной во время движения носителей 3. **Валидность модели**: Упрощённая теоретическая модель хорошо согласуется с поведением реальной системы ### Результаты сравнительного моделирования #### Без оптимизации (рис. 5-7) - **Траектория носителя**: Резкие повороты, приводящие к мгновенному снижению скорости до нуля - **Отслеживание груза**: Средняя ошибка положения 0,013 м, хорошая производительность отслеживания - **Ограничение скорости**: Многократные нарушения ограничения непрерывного полёта #### С оптимизацией (рис. 8-11) - **Траектория носителя**: Плавная эллиптическая траектория без резких поворотов - **Отслеживание груза**: Средняя ошибка положения 0,015 м, немного выше, но в приемлемых пределах - **Ограничение скорости**: Строгое соблюдение $\|\dot{p}_{R_i}\| \geq 0,2$ м/с - **Характеристики траектории**: Носители выполняют круговой полёт (loitering) при неподвижности груза ### Ключевые выводы 1. **Удовлетворение ограничений**: Алгоритм оптимизации успешно обеспечивает скорость носителей выше порога 2. **Производительность отслеживания**: Введение ограничения скорости оказывает незначительное влияние на точность отслеживания груза 3. **Гладкость**: Оптимизированные траектории значительно улучшают плавность движения носителей ## Связанные работы ### Одиночный носитель с подвешенным грузом Ранние исследования сосредоточены на одиночном многороторном аппарате, транспортирующем подвешенный груз, в основном решая проблему подавления колебаний [5-7]. ### Кооперативные многороторные системы Расширение на несколько многороторных аппаратов для кооперативной транспортировки с шестью степенями свободы управления грузом [8-13], но зависит от способности зависания. ### Теория непрерывно летающих носителей Недавние теоретические работы [14,15] установили возможность непрерывно летающих носителей поддерживать статическое равновесие груза, но ограничиваются только разомкнутым управлением. ### Позиционирование вклада данной работы Данная работа является первой, реализующей замкнутое управление динамическим отслеживанием груза непрерывно летающими носителями, заполняя важный пробел между теорией и практическими приложениями. ## Заключение и обсуждение ### Основные выводы 1. **Теоретический прорыв**: Впервые реализовано замкнутое управление отслеживанием траектории груза непрерывно летающими носителями 2. **Технические инновации**: Стратегия онлайн-оптимизации эффективно решает проблему связи между ограничением скорости носителя и управлением грузом 3. **Практическая верификация**: Метод показывает хорошие результаты на сложных траекториях (комбинация статики и динамики) ### Ограничения 1. **Упрощение динамики носителя**: Не учитывается полная динамика беспилотных летательных аппаратов с неподвижным крылом 2. **Разрешимость оптимизации**: В некоторых случаях задача оптимизации может быть неразрешима 3. **Диапазон экспериментов**: Предварительная верификация проведена только на многороторных платформах ### Направления будущих исследований 1. **Уточнённое планирование траектории**: Учёт насыщения входных сигналов и специфических ограничений состояния носителя 2. **Предсказывающее управление**: Применение методов скользящего горизонта вместо реактивной оптимизации 3. **Верификация на реальных беспилотниках**: Полномасштабные экспериментальные испытания на реальных непрерывно летающих беспилотниках 4. **Механическая интеграция**: Решение проблем механического крепления кабелей и груза ## Глубокая оценка ### Преимущества 1. **Высокая инновационность**: Впервые решена проблема замкнутого управления грузом непрерывно летающих носителей с важной теоретической ценностью 2. **Полнота методологии**: От теоретического моделирования через проектирование управления к экспериментальной верификации — сформирована полная техническая цепь 3. **Математическая строгость**: Математическая характеризация ограничения скорости носителя строга, проектирование задачи оптимизации рационально 4. **Практическая ценность**: Предоставляет осуществимый технический путь для дальней транспортировки грузов ### Недостатки 1. **Ограниченная экспериментальная верификация**: Верификация проведена только на многороторных платформах без экспериментов на реальных беспилотниках с неподвижным крылом 2. **Робастность оптимизации**: Недостаточное обсуждение разрешимости и робастности задачи оптимизации 3. **Обработка возмущений**: Способность обработки внешних возмущений и неопределённостей модели требует дальнейшей верификации 4. **Вычислительная сложность**: Вычислительная нагрузка онлайн-оптимизации и требования к реальному времени нуждаются в более детальном анализе ### Влияние 1. **Академический вклад**: Открывает новое направление исследований в области кооперативного управления непрерывно летающих носителей 2. **Перспективы приложений**: Обеспечивает важную техническую базу для логистики беспилотников, спасательных операций и других приложений 3. **Воспроизводимость**: Подробное описание методологии и явные параметры обеспечивают хорошую воспроизводимость ### Применимые сценарии 1. **Дальняя логистика**: Особенно подходит для задач транспортировки грузов, требующих большой дальности полёта 2. **Аварийно-спасательные операции**: Доставка материалов в отдалённые районы 3. **Морские операции**: Транспортировка грузов между морскими платформами 4. **Военные приложения**: Тактическая доставка материалов ## Список литературы Данная работа цитирует 16 соответствующих источников, охватывающих транспортировку подвешенных грузов, кооперативное управление многороторными аппаратами, приложения беспилотников с неподвижным крылом и другие ключевые области, обеспечивая прочную теоретическую базу. Особенно важные источники включают: - [14,15]: Пионерские работы Габеллиери и Франки по статическому равновесию непрерывно летающих носителей - [8-13]: Классические исследования кооперативной транспортировки многороторными аппаратами - [5-7]: Фундаментальная теория управления одиночным носителем с подвешенным грузом --- **Общая оценка**: Это высококачественная статья по теории управления, вносящая важный вклад в область кооперативного управления непрерывно летающих носителей. Хотя в экспериментальной верификации есть место для улучшения, её теоретическая инновационность и практическая ценность делают её важным прогрессом в этой области.