Алгоритм предотвращения столкновений мостового крана с AGV

В сценариях совместной работы мостовых кранов с AGV/RGV на одной линии алгоритм предотвращения столкновений определяет безопасность и эффективность взаимодействия. В отличие от жёсткой блокировки с фиксированными концевыми выключателями, алгоритмы предотвращения столкновений в реальном времени рассчитывают оптимальные параметры движения каждого устройства, активно уклоняясь от препятствий. В статье сравниваются три основных алгоритма — DWA, VO и APF, и предлагается гибридная схема.

Практическая реализация метода динамического окна DWA

Основная идея DWA (Dynamic Window Approach) заключается в дискретизации пространства скоростей (v, w) мостового крана или AGV, вычислении оценочной функции для каждой комбинации скоростей и выборе комбинации (v, w) с максимальной оценкой в качестве команды движения на следующий цикл. Пространство скоростей: v∈[0, v_max], w∈[-w_max, w_max]. Типичное разрешение дискретизации: 30 интервалов по линейной скорости и 30 по угловой, всего 900 комбинаций (v, w) за один цикл.

Оценочная функция G(v,w)=a·heading(v,w)+b·dist(v,w)+c·vel(v,w). Компонент heading оценивает отклонение угла направления движения от целевого направления (чем меньше отклонение, тем лучше), компонент dist — расстояние до ближайшего препятствия вдоль траектории (чем дальше, тем безопаснее), компонент vel — величину линейной скорости (высокая скорость повышает эффективность, но снижает способность к уклонению). Все три компонента нормализуются к интервалу [0,1] и суммируются с весовыми коэффициентами. Фактическое время выполнения DWA на NVIDIA Jetson Orin NX составляет около 120–180 мс (включая чтение данных, дискретизацию скоростей, вычисление оценки и вывод команды), что удовлетворяет требованию цикла 200 мс. Реализация DWA от Келуде Тяжёлая Промышленность на Jetson выполнена на C++ с использованием CUDA для параллельного ускорения вычислений: параллельная оценка 90 комбинаций (v, w) занимает всего 8 мс.

Адаптация DWA для мостового крана: мостовой кран имеет только одну степень свободы движения (вдоль оси X рельса), поэтому пространство скоростей DWA упрощается до одномерной дискретизации v_x∈[0, v_max] (угловая скорость w всегда равна нулю), количество комбинаций снижается с 900 до 30, а цикл вычислений сокращается до 30–50 мс. С другой стороны, тормозной путь мостового крана длиннее, чем у AGV (около 0,5 м при скорости 1 м/с), поэтому вес компонента dist в оценочной функции следует увеличить до b=0,5 (для AGV b=0,3), чтобы обеспечить достаточный безопасный тормозной путь. Стандартные параметры DWA для мостовых кранов Келуде Тяжёлая Промышленность: a=0,3, b=0,5, c=0,2 — проверены в 6 проектах.

Сравнение трёх алгоритмов предотвращения столкновений на практике

Применимость трёх алгоритмов в сценарии совместной работы крана с AGV существенно различается. DWA показывает наилучшие результаты в динамической неизвестной среде (оценочная функция учитывает три цели: направление, расстояние, скорость), VO обеспечивает наивысшую точность при согласовании скоростей нескольких устройств (геометрический вывод конуса скоростей), APF отличается минимальной вычислительной нагрузкой и максимальной скоростью реакции при статическом планировании траектории. Ниже приведено системное сравнение по пяти параметрам: математическая основа, цикл вычислений, аппаратные требования, адаптивность к динамике и сложность внедрения — для выбора оптимального алгоритма инженером под конкретные условия эксплуатации.

Реализация метода зоны скорости препятствий VO в промышленных условиях

Основная идея алгоритма VO (Velocity Obstacle) заключается в выделении в пространстве скоростей тех областей, которые приводят к столкновению. Определение: зона скорости препятствий VO(A,B)=v_A|(p_B-p_A)/t принадлежит D(p_B-p_A,r_A+r_B), где p_A/p_B — векторы положения двух устройств, r_A/r_B — радиусы описанных окружностей, t — время прогнозирования. Проще говоря: если устройство A движется со скоростью v_A, а устройство B — со скоростью v_B, то при попадании относительной скорости v_rel=v_A-v_B (наблюдаемой из точки A) в зону VO столкновение произойдёт в течение следующих t секунд.

Реализация VO в ПЛК: ПЛК S7-1500 реализует алгоритм VO на языке SCL примерно в 150 строк кода. В каждом цикле вычислений (100 мс) последовательно рассчитываются зоны VO для всех пар устройств (всего N×(N-1)/2 пар), и для текущей скорости каждого устройства проверяется, попадает ли она в какую-либо зону VO. Если скорость находится в зоне VO, вычисляется скорость уклонения (ближайшая безопасная скорость к границе VO), которая затем передаётся устройству в качестве команды ограничения скорости. Для 6 устройств объём вычислений составляет примерно 15 пар × около 50 инструкций на пару = 750 инструкций, время выполнения на S7-1500 — около 2–3 мс. При одновременном запуске DWA+VO ПЛК отвечает за часть VO (2–3 мс), а Jetson — за часть DWA (120–180 мс); обмен данными осуществляется через Profinet.

Ограничения VO и пути их устранения: VO предполагает равномерное прямолинейное движение другого устройства — при внезапном ускорении, замедлении или повороте прогноз VO становится недействительным. Существует два способа улучшения: ① учёт ограничений ускорения — при расчёте VO учитывается максимальный диапазон ускорения другого устройства, а конус скорости расширяется до конуса ускорения (Accelerated VO); ② сокращение времени прогнозирования t — с t=5 секунд (для мостовых кранов) до t=2 секунд, что позволяет обменять оперативность на точность прогноза: при t=2 секунды точность прогнозирования столкновений VO составляет около 92%, при t=5 секунд — снижается до 78%. Компания Келуде Тяжёлая Промышленность рекомендует значение t=3 секунды по умолчанию, обеспечивающее совокупную точность около 88%.

Практический пример гибридного алгоритма для цеха

Проект совместной диспетчеризации в цехе окончательной сборки автомобильного завода включает 6 мостовых кранов, 12 AGV и 4 RGV и охватывает весь процесс грузопереработки от выхода штампованных деталей до сварочного цеха. Компоновка линии: пролёт кранов 28–31,5 м, ширина проездов для AGV 2,5–3 м, 6 стыковочных позиций «кран-AGV» и 4 точки сопряжения AGV-RGV. В пиковые часы выполняется около 280 операций перемещения (в среднем 12,8 секунды на операцию). Краны отвечают за перемещение между пролётами, AGV — за наземную транспортировку, RGV — за передачу на дальние расстояния по рельсам. Траектории трёх типов устройств пересекаются в 18 точках, что создаёт высокую сложность контроля риска столкновений.

Конфигурация алгоритмов: Jetson Orin NX (100 TOPS) выполняет DWA (локальное планирование траектории AGV, период 200 мс), ПЛК S7-1500 выполняет VO (координация скоростей нескольких устройств, период 100 мс), APF обеспечивает глобальное направление движения (рассчитывается один раз при выдаче задачи, около 10 мс). Взаимодействие трёх алгоритмов: APF формирует глобальную траекторию → VO выполняет обнаружение конфликтов и формирует ограничения скорости → DWA в рамках ограничений выбирает оптимальную команду (v, ω). Связь между диспетчерским ПЛК и Jetson осуществляется через Profinet IRT (период 2 мс), фактическая задержка канала — около 280 мс.

Результаты внедрения: после запуска — 12 месяцев непрерывной работы без единого столкновения. Среднее время ожидания задачи снизилось с 25 секунд (при ручной диспетчеризации) до 12 секунд (снижение на 52%), простой кранов сократился с 41% до 23%, простой AGV — с 38% до 19%, эффективность перемещения материалов по линии выросла на 37%. Компания Келуде Тяжёлая Промышленность предоставляет услуги по разработке алгоритмов под заказ, включая обследование объекта, моделирование, выбор алгоритма, развёртывание Jetson, разработку для ПЛК и четырёхэтапное тестирование с приёмкой.

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

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

Этап 1. Чисто программное моделирование (Gazebo + Rviz): в среде ROS 2 создаются 3D-модели мостового крана и AGV, импортируется компоновка производственной линии (координаты рельсов, траекторий, стыковочных позиций), выполняется 200 случайных задач перемещения (включая 5% срочных задач и 3% сценариев отказа оборудования), фиксируется количество столкновений и эффективность траекторий. Критерий прохождения: ноль столкновений + средняя эффективность траектории ≥ 85% от показателей ручного управления.

Этап 2. Аппаратно-программное моделирование (HIL): к среде моделирования подключаются реальные Jetson-модуль и ПЛК с развёрнутыми алгоритмами. Jetson получает от ПЛК имитированные сообщения о состоянии устройств (через Profinet), выполняет алгоритмы DWA+VO и выдаёт команды скорости виртуальным устройствам. Основные проверки: подтверждение соответствия задержки Profinet требованию периода 100 мс, а также проверка того, что время выполнения алгоритмов на реальном оборудовании не превышает бюджет цикла (DWA ≤ 200 мс, VO ≤ 100 мс).

Этап 3. Испытания на реальном оборудовании без нагрузки: на действующей линии мостовые краны и AGV работают вхолостую в течение 48 часов под постоянным наблюдением специалиста по безопасности; фиксируются частота ложных срабатываний алгоритма и количество аномальных действий.

Этап 4. Опытная эксплуатация под нагрузкой: скорость постепенно повышается до номинальной, испытание длится 168 часов (7 дней). С помощью встроенной KPI-системы системы диспетчеризации регистрируются среднее время ожидания задачи, частота конфликтов и показатель своевременности; проводится сравнительный анализ за неделю до и неделю после запуска. Компания Келуде Тяжёлая Промышленность предоставляет услуги по проведению всех четырёх этапов тестирования с выдачей отчёта по каждому этапу.

Часто задаваемые вопросы о системах предотвращения столкновений

• Стандарт ISO 4301 / FEM 1.001 «Основные положения спецификации проектирования кранов: нагрузка, конструкция, механизмы, электрооборудование и безопасность»