Аннотация: Один из подходов к решению задачи оптимального управления движением манипуляционного робота по заданной геометрической траектории предполагает разбиение задачи на два этапа. На первом вне реального времени осуществляется формирование оптимальных по заданному критерию траекторий движения в каждой степени подвижности как функций времени, обеспечивающих движение рабочего органа манипулятора по заданной геометрической траектории с оптимальной скоростью. На втором этапе в реальном времени происходит отслеживание сформированных на первом этапе траекторий. Ниже рассмотрен метод формирования оптимальных траекторий движения при зависящих от состояния манипулятора ограничениях на развиваемые силы и моменты и зависящих от конфигурации манипулятора ограничениях на скорости движения в степенях подвижности. В отличие от известных алгоритмов предложенный подход не требует представления заданной геометрической траектории в параметрической форме, а допускает ее указание последовательностью точек.
Ключевые слова: траектория, манипулятор, движение.
Технические науки
УДК 621.865.8.001
Чудинов Владислав Александрович
Chudinov Vladislav Alexandrovich
студент, кафедра Автомобили технологические машины, автодорожный факультет, Пермский национальный исследовательский политехнический университет
г. Пермь, Российская Федерация
Бруданов Антон Михайлович
Brudanov Anton Mikhailovich
студент, кафедра Автомобили технологические машины, автодорожный факультет, Пермский национальный исследовательский политехнический университет
г. Пермь, Российская Федерация
ОПТИМАЛЬНОЕ ФОРМИРОВАНИЕ ТРАЕКТОРИЙ ДВИЖЕНИЯ МАНИПУЛЯЦИОННЫХ РОБОТОВ С ИСПОЛЬЗОВАНИЕМ ДИНАМИЧЕСКОГО ПРОГРАММИРОВАНИЯ
OPTIMIZATION OF TRAJECTORIES ROBOTIC MANIPULATOR USING DYNAMIC PROGRAMMING
Аннотация: Один из подходов к решению задачи оптимального управления движением манипуляционного робота по заданной геометрической траектории предполагает разбиение задачи на два этапа. На первом вне реального времени осуществляется формирование оптимальных по заданному критерию траекторий движения в каждой степени подвижности как функций времени, обеспечивающих движение рабочего органа манипулятора по заданной геометрической траектории с оптимальной скоростью. На втором этапе в реальном времени происходит отслеживание сформированных на первом этапе траекторий. Ниже рассмотрен метод формирования оптимальных траекторий движения при зависящих от состояния манипулятора ограничениях на развиваемые силы и моменты и зависящих от конфигурации манипулятора ограничениях на скорости движения в степенях подвижности. В отличие от известных алгоритмов предложенный подход не требует представления заданной геометрической траектории в параметрической форме, а допускает ее указание последовательностью точек.
Аnnotation: One approach to solving the problem of optimal control of the movement of the handling robot for a given geometric path involves partitioning the problem into two stages. The first is carried out real-time formation of optimal trajectories specified criteria for each degree of mobility as a function of time, provide a working body of the manipulator motion for a given geometric path with optimum speed. The second stage takes place in real time tracking formed in the first phase trajectories. The following describes the method of formation of the optimal trajectories with dependent constraints manipulator state in the emerging forces and moments, and depending on the configuration of the manipulator restrictions on the movement speed in degrees of mobility. In contrast to the known algorithms proposed approach does not require the submission of a given geometric path in parametric form, and allows her to specify the sequence of points.
Ключевые слова: траектория, манипулятор, движение.
Keywords: trajectory, manipulator , movement.
Проблемы формирования оптимальных траекторий может быть сформулирована как задача оптимального управления. Для динамической системы
с начальным состоянием и конечным состоянием при заданном или свободном времени окончания процесса требуется найти управление и соответствующее состояние , оптимизирующие показатель качества
при ограничениях в форме равенств и неравенств вида
При планировании оптимальных траекторий движения манипулятора используются уравнения математики
и динамики
где p – вектор, представляющий положение рабочего органа манипулятора в декартовой системе координат; q – вектор, представляющий перемещения в степенях подвижности манипулятора. В качестве управления u рассматриваются развиваемые приводами в степенях подвижности силы и моменты. Начальное состояние определяется равенствами и . В конечный момент и . Ограничения вида равенств q(q) = 0 определяют требуемую геометрическую траекторию. Ограничения вида неравенств устанавливают пределы изменения развиваемых приводами сил (моментов) и скоростей
В дальнейшем рассматриваются две задачи оптимизации: ( ) минимизация времени движения
K = 0, L = 1, J = ;
минимизация энергозатрат
K = 0, L = , J = ;
комбинация задач ( ) и
K = 0, L = , J = = ;
где и – весовые функции.
В связи с использованием для решения задачи цифровых ЭВМ приведена эквивалентная постановка задачи в дискретной форме. Требуется для динамической системы, описываемой уравнениями
с начальным и конечным состояниями
При отсутствии ограничений на время движения, найти управление u(k) и соответствующее состояние оптимизирующие один из следующих показателей качества
при ограничениях
Для решения этой задачи предложено использовать метод динамического программирования. Такой подход позволяет получить универсальный алгоритм формирования оптимальных траекторий при различных ограничениях и показателях качества. Облегчает использование метода то обстоятельство, что при заданной геометрической траектории положение в одной степени подвижности определяет положения в остальных. В результате существенно снижается размерность задачи.
Пусть r – индекс дискретной точки на заданной геометрической траектории. Для заданного в декартовых координатах положения рабочего органа в точке r путем решения обратной задачи кинематики манипулятора можно определить соответствующие обобщенные координаты q(k). Пусть – множество возможных скоростей движения в степени подвижности i в точке r, которое получается путем дискретизации диапазона скоростей
В том случае, когда ограничения скорости не указаны, ее предельные значения могут быть получены из ограничений сил (моментов). Рассмотрим переход манипулятора из точки k и k+1. Предполагается, что величина перемещения мала, а ускорение постоянно. Для возможной скорости и допустимой скорости ускорение движения в сочленении i в точке k определяется выражением
и время перехода между двумя точками
Поскольку перемещение в следующую точку для всех степеней подвижности должно завершаться за один и тот же временной интервал, можно определить скорости движения в остальных степенях подвижности в точке k как
Если какая-либо из скоростей , [ j = 1,2..,n, j ≠ i ] не удовлетворяет ограничениям для скоростей, то скорость считается недопустимой. Если все скорости удовлетворяют ограничениям, то для каждой степени подвижности вычисляется ускорение. Далее по полученным значениям перемещений, скоростей и ускорений вычисляются силы (моменты), которые необходимо приложить в степенях подвижности для выполнения перемещения из точки k в k+1. Если при этом оказывается, что какая-либо из сил (моментов) выходит за допустимые пределы, то скорость также полагается недопустимой. Пусть обозначает приращение показателя качества при перемещении между точками r и r+q и обозначает наименьшее значения показателя качества при переходе из r-той точки в конечное состояние. Используя принцип оптимальности Беллмана, можно получить
где – множество допустимых значений в точке . Это уравнение применяется к каждой допустимой скорости в точке k и позволяет для каждой скорости найти единственную оптимальную скорость в точке и скорости в остальных степенях подвижности, а также силы (моменты), соответствующие оптимальным условиям в точке k. Оптимизационный процесс начинается в конечном состоянии и распространяется в направлении к началу. Алгоритм планирования оптимальных траекторий включает в себя следующие этапы:
Далее рассматриваются вычислительные аспекты рассмотренного алгоритма. Предложены подходы, направленные на повышение вычислительной эффективности процедуры формирования оптимальных траекторий. Рассматривается случай, когда в явном виде не указаны ограничения на скорости движения в степенях подвижности и заданы только силовые ограничения. Для того чтобы получить скоростные ограничения нужно переписать уравнение динамики в виде
Подставляя в это уравнение выражение из (21), можно получить
Это уравнение можно использовать для определения граничных значений скорости в сочленении i при движении по заданной геометрической траектории. Видно, что скорость принимает максимальное значение, если
и наименьшее значение, если
где и – соответственно максимальное и минимальное значение момента.
Верхняя граница может быть получена путем осуществления на первом этапе максимизации при продвижении от начального состояния к конечному. Полученная функция монотонно возрастает. На втором этапе этот процесс повторяется при продвижении из конечного состояния к начальному. Подобным образом (с использованием минимизации ) может быть найдена нижняя граница скорости . Таким образом, полученные четыре кривые ограничивают допустимую область изменения скорости
Точность траектории зависит от разрешающей способности при дискретизации скорости. Увеличение числа уровней дискретизации позволяет повысить точность решения, но существенно удлиняет продолжительности вычислений. Для любого сегмента траектории. если имеется , возможные скорости в начале сегмента и в его конце, то в худшем случае алгоритм требует выполнения вычислений. Предлагается метод рекуррентного повышения разрешающей способности, требующий значительно меньших вычислительных затрат. Вначале формируется субоптимальное решение с использованием грубой дискретизации, а затем в окрестности полученного решения используется более мелкая дискретизация. Если такое рекуррентное уточнение повторяется ß раз, каждый раз разбивая скорость на m уровней, достигается эквивалентная дискретизация на уровней. Сложность вычислений на каждом сегменте пропорциональна квадрату числа уровней дискретизации. Таким образом, время вычислений имеет порядок при использовании предложенной рекуррентной процедуры и при эквивалентной разрешающей способности без использования рекуррентного уточнения. Отсюда видно, что предложенная процедура позволяет значительно сократить время вычислений.
Литература