Шагоходы или шагающие роботы – разнообразные механизмы, передвигающиеся с помощью ног. Ввиду технических сложностей исполнения они не получили пока в реальной жизни большого распространения. Из используемых на практике механизмов можно назвать шагающие экскаваторы. Шагающие роботы весьма популярны в научной фантастике. По сравнению с колёсной и гусеничной техникой шагоходы имеют повышенную проходимость на пересеченной местности. Главной проблемой при создании шагоходов является соотношение цены и эффективности, а также отсутствие достаточно мощной, емкой и компактной энергоустановки. Одной из важнейших и сложнейших научных задач, которые необходимо решить при создании такого робота – это собственно задача управления ходьбой.
Актуальным является создание шагающих мобильных автономных роботов, способных работать в экстремальных условиях, таких как открытый космос или сильно пересеченная местность.
Прямая задача о положении
Для разработки алгоритмов управления шагающим роботом с 4 движителями реализована экспериментальная физическая модель. Кинематическая схема [1] представлена на Рисунке 1.
Механизм состоит из корпуса 1 и 4 ног. Каждая из ног имеет 3 степени свободы благодаря вращательным одноподвижным сочленениям перемещается робот A1 - C4 . Точки D1 - D4 – точки контакта с поверхностью, по которой
Будем рассматривать структуру одной ноги робота.
Прямая задача о положении в нашем случае может быть сформулирована как определение декартовых координат (X,Y,Z) точки касания D при известной кинематической схеме и величинах обобщенных координат( q1, q2 … qn ) его звеньев (n — число степеней свободы манипулятора).
Для манипулирования роботом, состоящим из совокупности звеньев, требуется определить его пространственную конфигурацию с учетом положения всех звеньев. Конфигурация может быть определена путем последовательного описания взаимного расположения соседних звеньев манипулятора. Для этого строятся системы координат, связанные с каждым звеном ноги. Воспользуемся векторно-матричным методом преобразования координат, предложенным Денавитом и Хартенбергом. Упрощенная конструкция ноги с связанными с каждым звеном системами координат, построенными по алгоритму Денавита-Хартенберга, представлена на Рисунке 2.
Связь точек D и O, представляющих собой начала координат, связанных с корпусом робота и концом ноги, описывается формулой D = T1T2T3 p, где D – однородные координаты точки D в системе координат OX0Y0Z0 , p – координаты точки D в CX3Y3Z3 , Ti - матрица преобразования системы координат Xi-1Yi-1Zi-1 в систему координат XiYi Zi .Параметры преобразований указаны в Табл.1.
Обратная задача о положении
Обратная задача о положении в нашем случае может быть сформулирована как определение обобщенных координат ( q1, q2 … qn ) точки D по заданной кинематической схеме и декартовым координатам (X, Y, Z). Известны различные методы решения обратной задачи о положении. Далее предложен геометрический вариант решения (Рисунок 5).
Расчет обобщенных координат ноги при смещении корпуса вдоль оси x и y без поворота и отсутствии смещения в точке касания с землей.
Из треугольника A1A2D можно составить систему уравнений:
Таким образом, задача имеет два решения, когда нога расположена выше линии, соединяющей точку крепления с корпусом и точку контакта с землей, и когда ниже. Из конструктивных соображений для более высокой устойчивости выбираем тот вариант, когда ноги с поверхностью образуют выпуклый многоугольник.
Тогда решение обратной задачи выражается следующими формулами
Список литературы
1. Edward Z. Moore. Leg Design and Stair Climbing Control for the RHex Robotic Hexapod. - Department of Mechanical Engineering McGill University, 2002. - 91c.
2. Батанов А.Ф., Грицынин С.Н., Муркин С.В. Робототехнические комплексы для обеспечения специальных операций. [Электронный ресурс] Специальная техника, 1999, вып. 6. Режим доступа: http://www.ess.ru/archive/1999 (дата обращения 26.10.2015)
3. Накано Э. Введение в робототехнику/ НаканоЭ. - М.: Мир, 1988, 335 с.
4. FizPortal Шагающие роботы. Механика. [Электронный ресурс] Режим доступа: http://www.fizportal.ru/walking-robots (дата обращения 23.10.2015)
5. Зенкевич, С.Л. Основы управления манипуляционными роботами/ С. Л. Зенкевич, А. С. Ющенко. — М.: Изд-во МГТУ им. Н. Э. Баумана, 2004.
6. Воробьев, В.А. Промышленные роботы. Кинематика, динамика, контроль и управление/ В. П. Попов, В. А. Воробьев, В.П. Попов. — М.: Солон-пресс, 2007 г.