Разработка симулятора автономного необитаемого подводного аппарата

Ключевые слова: моделирование, подводный аппарат, автономный аппарат, симулятор, робототехника.

Робототехника стремительно развивается в направлении водных средств [1-5]. Несмотря на практическую значимость разработки автономных подводных аппаратов, удаленность и агрессивность среды, в которой они функционируют, делает процесс их разработки довольно сложным. В дополнение к необходимости доставки и развертывания робота в области применения, есть также риск повреждения дорогостоящего оборудования на протяжении всего процесса отладки.

Инструментарий моделирования автономного необитаемого подводного аппарата (АНПА) требует разработки математической модели [5,6,7], трехмерной среды моделирования и визуализации, режима функционирования в реальном времени, гибкость, способность работать на различных конфигурациях компьютеров и высокую интеграцию с системой управления роботом [8,9].

Последнее требование означает необходимость одинакового и единообразного функционирования системы управления как с имитируемыми, так и с реальными физическими устройствами (например, датчиками, исполнительными механизмами) [10].

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

Архитектура симулятора АНПА. Универсальные среды математического моделирования, которые используются при разработке робототехнических систем (такие как, например, MATLAB и Simulink), позволяют выполнять численное моделирование и визуализировать результаты в виде графиков. При том, что данные средства весьма полезны для разработки отдельных модулей и алгоритмов, их использование для моделирования робототехнической системы в целом, в том числе взаимодействия с аппаратными средствами, трехмерной визуализации затруднено. Таким образом, использование универсальных сред математического моделирования недостаточно и требуется специализированное решение.

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

- программы моделирования АНПА и морской среды (в том числе блоки моделирования морской среды, гидродинамических характеристик, энергосиловой установки, исполнительных механизмов, движения АНПА);

- программы трехмерной визуализации и моделирования системы предупреждения столкновений АНПА (в том числе блок трехмерной визуализации движения АНПА и внешней среды);

- программы моделирования судовой системы управления, обработки и отображения информации.

Размещено на http://www.allbest.ru/

Рис. 1. Состав симулятора

Программы комплекса моделирования интегрированы между собой, их взаимодействие осуществляется автоматически посредством протоколов TCP/IP и UDP.

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

Функциональная схема симулятора представлена на рис. 2

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

Обмен данными между модулями осуществляется посредством универсальных интерфейсов данных - «именованных каналов», выделенных серой заливкой на схеме. При работе в режиме моделирования данные телеметрии публикуются, а команды управления исполнительными механизмами читаются программными модулями симулятора. При реальных испытаниях данные телеметрии публикуются соответствующими программными интерфейсами датчиков и навигационной системы, а команды управления исполнительными механизмами передаются на электронные блоки исполнительных механизмов посредством соответствующих программных интерфейсов. Таким образом, реализуется одинаковая работа модулей системы управления в режиме моделирования и при реальных испытаниях. Команды от судовой системы связи, обработки и отображения информации передаются в систему управления, а данные телеметрии в судовую систему связи, обработки и отображения информации одинаково как в режиме моделирования, так и в режиме реальных испытаний. Таким образом, для оператора работа в режиме моделирования ничем не отличается с работой с реальной системой управления.

симулятор отладка робототехнический подводный

Рис. 2. Функциональная схема симулятора

Для обмена данными между системой управления и судовой системой связи, обработки и отображения информации используется протокол MAVLink.

Формат MAVLink предназначен для упаковки и распаковки структур сообщений (на языках C/C++, C# или Python) для их отправки по каналу связи.

Формат сообщений задается в файлах XML (файл common.xml) и затем конвертируется в код на языках C/C++, C# или Python.

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

Модуль также осуществляет трехмерную визуализацию среды функционирования АНПА (сцены). В процессе моделирования сцена состоит из следующих элементов, показанных на рис. 3.

Рис. 3 - Внешний вид программы после загрузки тестового проекта сцены: 1 модель АНПА; 2 модель сенсорной подсистемы АНПА - сонара; 3 ландшафт; 4 препятствие-мина; 5 препятствие-бочка; 6 текущий целевой объект; 7 начало координат сцены

Настройка симулятора осуществляется посредством файла в формате INI и графического интерфейса редактирования этого файла в виде иерархической структуры, показанного на рис. 4. Настройками симулятора являются:

- характеристики АНПА;

- характеристики исполнительных механизмов АНПА;

- настройки системы управления АНПА;

- характеристики потребляемого питания полезной нагрузки;

- настройки системы предупреждения столкновений;

- настройки моделирования течений.

Рис. 4. Редактирование настроек комплекса моделирования

Моделирование различных вариантов движения АНПА. Возможность моделирования различных вариантов движения АНПА показана на рис.5 (заданы различные варианты траектории движения).

Рис. 5. Моделирование различных вариантов движения АНПА: слева - заданная (синяя) и моделируемая (красная) траектория АНПА на карте; справа - полученная траектория в виде графика изменения координат

Оценка затрат энергии. Зависимость затрат энергии от режима использования полезной нагрузки показана на рис. 6.

На участке 0-1 работала полезная нагрузка 1, на участке 1-2 работали полезная нагрузка 1 и 2, на участке 3 - не работала ни одна полезная нагрузка.

Рис. 5. Зависимость затрат энергии от режима использования полезной нагрузки

Моделирование системы диагностики и имитация отказов. Имитация и диагностика отказов осуществляется по отсекам АНПА, как показано на рис. 7. Состояние блока может быть одним из следующих: нормальное (без подсветки либо зеленая при наведении), функционирует с ошибками (желтый цвет), аварийное (красный цвет).