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

Рассматривается задача приведения конечного эффектора (центра схвата) антропоморфного манипулятора подводного аппарата в заданное положение за заданное время с помощью метода конечного состояния. На основе полученной кинематической модели антропоморфного манипулятора, построенной на основе подхода Денавита – Хартенберга (DH-модель), сформулирована динамическая модель, учитывающая динамику приводов сочленений. DH-модель использована в терминальном нелинейном критерии, отображающем близость ориентации и положения эффектора к заданным значениям. Динамическая модель приспособлена для эффективного применения авторского метода конечного состояния (МКС) и представляет собой систему дифференциальных уравнений для углов поворота звеньев манипулятора вокруг продольных и поперечных осей, правые части которой содержат только искомые МКС-управления. Такая модель позволила существенно упростить расчет управлений за счет упразднения численного решения дифференциальных уравнений специального вида, необходимых в случае использования в МКС нелинейных динамических моделей общего вида. Найденные МКС-управления далее использованы в выражениях для управляющих воздействий на электроприводы сочленений, полученных на основе динамических моделей электроприводов. Предполагается, что неизвестные параметры приводов, как функции углов поворота звеньев и других неизвестных факторов, могут быть определены экспериментально. Такая двухэтапная процедура позволила получить управление приводами в форме алгебраических и трансцендентных выражений. Наконец, представлены результаты моделирования процессов приведения конечного эффектора манипулятора в заданные положения на границах рабочей области с помощью разработанного программного обеспечения. Полученная при этом погрешность без учета погрешности измерений составила величины, не превышающие двух сантиметров на максимальном вылете руки длиной 1,2 метра. Работа выполнена в рамках федеральной целевой программы по разработке роботизированного аппарата, предназначенного для подводных исследовательских работ на малых глубинах (до 10 метров).