Способ кодирования информации при задании геометрических моделей исполнительных механизмов роботов

При разработке конструктивных особенностей исполнительных механизмов в робототехнических системах существует необходимость в решении ряда геометрических задач, связанных с моделированием процессов управления движением [1, 2]. Анализ взаимного положения исполнительного механизма манипулятора по отношению к заданной окружающей среде при выполнении двигательных заданий требует разработки обобщенных способов задания их геометрических моделей. При этом существует необходимость кодированного представления информации о указанных моделях [3, 4]. В настоящей работе изложен способ кодирования геометрической информации при задании исполнительных механизмов на основе использования заданного набора пространственных примитивов и их ориентации в подвижных системах координат. Предложен новый метод обозначения геометрических моделей механизмов роботов при использовании совокупностей пространственных примитивов.

Рассмотрим исполнительные механизмы роботов, представленные на рис. 1аб. Положение узловых точек и подвижных звеньев механизма в неподвижном пространстве определяют совокупность матриц M0,1, M0,2,, M0, nm размерности 44 [5, 6]. Параметр nm определяет число систем О1, О2, …, Оnm, используемых при задании геометрических моделей механизмов манипуляторов. Для излагаемых примеров задания геометрических моделей механизмов роботов nm? n и для первого и второго механизмов, представленных на рис. 1аб соответственно указанный параметр равен nm = 8 и nm = 10. Где n — задает число обобщенных координат механизма манипулятора. Матрицы M0, k определяют произведением матриц Mk-1, k. механизм робот кодирование информация Заметим, что в каждой из систем Оnm может быть заданы, один или несколько объемных примитивов, в качестве которых могут выступать призма, усеченная пирамида, цилиндр вращения, усеченный конус и д.р. Для некоторых моделей механизмов роботов при их задании могут быть использованы подвижные системы координат, в которых могут отсутствовать пространственные примитивы. Вид объемного примитива и его ориентация в системе Оk (nm k 1) определяют соответственно значения кодов npr и nor. В табл. 1 приведены некоторые значения кодов npr и nor в зависимости от вида объемного примитива. Из таблицы 1 ясен геометрический смысл массивов ai (a1, a2, … anm) и переменных под массивов a1(ya, yb, za, zb, h1,1, h2, 2), a2(yo, zo, d, 0, h1, 1, h2, 2) …, задающих соответствующий объемный примитив в подвижной системе координат. C помощью задания различных значений первых четырех элементов под массивов а1, а2, а3, … массива аi имеется возможность формировать плоские контуры различной формы и положения относительно центра пользовательской системы координат (ПСК). Переменные 1 и 2 могут принимать как нулевые так и не нулевые значения. При этом функции (подпрограммы) Auto LISP заданные кодами npr в зависимости от этого могут строить изображения и создавать модели призмы, пирамиды, цилиндра, усеченного конуса и т. п. Параметры h1 и h2 принимают нулевые или положительные значения. В зависимости от этого примитив может располагаться по одну или две стороны относительно конструктивной плоскости ПСК. ПСК определяют вектора rО, rA, rВ, rС точек О, А, В, С задающих центр ПСК и точек располагающихся на соответствующих осях подвижной системы координат Оk (см. табл. 1). Количество объемных примитивов в подвижных системах координат определяет список nkol .

Предлагается метод кодирования геометрической информации, сущность которого заключается в задании значений совокупностям элементов массивов. Для расчета элементов матриц Mk-1,k используют массивы i, lk, lsm и nkod [3]. Указанные массивы задают соответственно значения обобщенных координат i, длины звеньев механизмов lk, смещения вдоль осей систем координат lsm, неподвижно связанных со звеньями механизма и коды преобразований систем координат nkod. Массивы аi определяют геометрические параметры объемных примитивов. Размерность массивов i, lk, lsm, nkod, nkol, npr, nor и аi (а1, а2, а3, … аnm) является одинаковой и определяется значением параметра nm [7]. При этом в указанных массивах в общем случае могут присутствовать пустые элементы (нули), которые предназначены для обеспечения заданной одинаковой размерности массивов с целью организации циклов при расчетах. Размерность под массивов а1, а2, а3, … аnm задающих геометрическую информацию об объемных примитивах при этом равна восьми. Массив аi (а1, (а2 /, а2//), а2, а3 … аnm) определяет два объемных примитива связанных со второй подвижной системой координат (см. табл. 1).

А б Рис. 1 Общий вид и геометрические параметры, задающие механизмы роботов: а — РМ-01, б — РБ-211

Выходные звенья механизмов манипуляторов, изображенных на рис. 1аб, имеют шесть степеней подвижности. Значения массивов i, lk, lsm, nkod, nkol, npr, nor и аi для механизмов, представленных на рис. 1аб заданы в таблице 2. Условимся в дальнейшем обозначать геометрические модели механизмов с указанием в обозначении объемных примитивов и их ориентации. В этом случае обозначение Мnkod (npr, nor) определяет соответственно код nkod (112) преобразований систем координат, код npr (14) объемного примитива и код nor (13) его ориентации. В соответствии с указанной методикой, обозначения геометрических моделей роботов РМ-01 и РБ-211 будут следующими: М3(2,2)-2((2,2)(4,3))-12(2,2)-2((2,2)(4,3))-3(2,3)-12(2,2)-2(1,3)-3(1,3) и М3(2,3)-2(4,3)-12(0,0)-2(4,3)-12(0,0)-1(1,3)-12(2,2)-2(2,2)-12(0,0)-3(2,3). В этом случае при задании геометрических моделей используются соответственно восемь и десять систем координат. Заметим, что во второй и четвертой подвижных системах робота РМ-01 заданы два примитива. При задании изображений конфигураций робота в виде отрезков прямых значения списков i, lk, lsm и nkod заданы в таблице 3.

На рис. 2 представлена блок-схема формирования изображений 3D модели исполнительных механизмов роботов имеющих произвольную структуру и произвольную форму звеньев механизмов. В блок-схеме приняты следующие обозначения: 1 ввод данных: (mok массив матриц, определяющих положение звеньев механизма; nkol — массив определяющий количество примитивов в подвижных системах координат; npr массив кодов примитивов; nor массив, определяющий ориентацию примитивов; a1 массив, определяющий геометрические параметры примитивов, nk = 0; 2 nk = (nk+1); 3 извлечение элементов массивов mok$>(nth nk mok), nkol$>(nth nk nkol), npr$>(nth nk npr), nor$>(nth nk nor), a1 $>(nth nk a1), nkol1 = 0 (где, nth является функцией Автолисп); 4 проверка условия npr$ = 0; 5 проверка условия npr$ = 1; 6 проверка условия npr$ = 2; 7 проверка условия npr$ = 3; 8 проверка условия npr$ = 4; 9 формирование модели и изображения примитивов призмы или пирамиды с помощью функции prim_pir (на основе массивов mok$, a1 $ и значения кода nor$); 10 формирование примитивов цилиндра или усеченного конуса с помощью функции prim_kon; 11 формирование примитива клин, с помощью функции prim-klin; 12 формирование примитива ограниченного кинематической поверхностью (заданной верхним и нижним основанием) с использованием функции prim_kin; 13 сообщение: «Некорректно введен код примитива»; 14 проверка условия n? nmat (nmat = nm); 15 проверка условия nkol1 nkol$; 16 nkol1 = nkol1+ 1, nk = nk + nkol1, a1 $ > (nth n a1); 17 конец.

На рис. 3 представлена блок-схема формирования изображений примитивов призмы и усеченной пирамиды с различной ориентацией. В блок-схеме рисунка 3 приняты следующие обозначения:

Таблица 1.

Некоторые значения кодов nрr и nоr пространственных примитивов.

nоr.	Значения кодов nрr (название функций).
	1 (prim_pir).	2 (prim_kon).	3 (prim-klin).	4 (prim_kin).
nоr = 1, ПСК (ro, rB, rC).	a1(ya, yb, za, zb, h1,0,. h2,0).	a2(y0,z0, d, 0, h1, 0, h2,0).	a3(ya, yb, za, zb, h1, h2, 0*, 0*).	a4(ya, yb, za, zb, h1, 1,0,0).
	a1(ya, yb, za, zb, h1, 1, h2,2).	a2(y0,z0, d, 0, h1, 1,. h2, 2).	a3(ya, yb, zb, za, h1, h2, 0*, 0*).	a2(ya, yb, za, zb, h1,1, h2,2).

1 Ввод данных mok$, nor$, a1 $; 2 Извлечение элементов списков V0 > (list (nth 4 mok$) …), VX > (list (nth 1 mok$) …), VY > (list (nth 2 mok$) …), VZ > (list (nth 3 mok$) …); a1 > (nth 5 a1 $), a2 > (nth 6 a1 $), a3 > (nth 7 a1 $), a4 > (nth 8 a1 $). V0 радиус-вектор центра системы координат Оk, VX, VY, VZ — единичные направляющие векторы осей xk, y k, z k системы Оk; 3 проверка условия nor$ = 1; 4 проверка условия nor$ = 2; 5 проверка условия nor$ = 3; 6 вычисление векторов с целью задания ПСК: rO = VO; rA =f1(VO, VY); rB = f2(VO, VZ), где f1 и f2 — функции, определяющие разность векторов; 7 RO = VO; rA = f1(VO, VX); rB= f2(VO, VZ); 8 rO = VO; rA = f1(VO, VX); rB = f2(VO, VY); 9 сообщение: «Некорректно введён код примитива»; 10 проверка условия a1 = 0; 11 проверка условия a3 = 0; 12 проверка условия a2 = 0; 13 проверка условия a4 = 0; 14 формирование модели призмы (высота a1 > 0); 15 формирование изображения пирамиды (а1 > 0); 16 формирование изображения призмы (а1<0); 17 формирование изображения пирамиды (а1 < 0); 18 конец.

Таблица 2.

Значения массивов и кодов, определяющих геометрические модели механизмов роботов РМ01 и РБ-211.

Таблица 3

Значения массивов и кодов, определяющих геометрические модели механизмов роботов РМ01 и РБ-211 при задании звеньев в виде отрезков прямых.

Рис. 2 Блок-схема формирования изображений 3D-модели исполнительных механизмов роботов

На рис. 4аб представлено моделирование движения роботов РМ01 и РБ-211 с использованием системы САПР ACAD и алгоритмического языка программирования Auto LISP при использовании визуального стиля «2D-каркасный».

Рис. 3 Блок-схема формирования примитивов призмы и пирамиды

Разработанный метод кодирования геометрической информации, позволяет проводить генерацию обобщенных моделей и анализ перемещений звеньев исполнительного механизма робота при виртуальном моделировании движений и определении траекторий в многомерном пространстве обобщенных координат [8]. Предложенная методика составления массивов и задания значений кодов, в сравнении с существующими методами [9, 10] позволяет определять положение и форму объемных примитивов в подвижных системах координат. Данные примитивы с определенным допущением задают форму и размеры подвижных звеньев механизмов.

а в.

Рис. 4. Моделирование движений механизмов роботов в системе САПР ACAD: а — РМ01 — M3(2,2)-2((2,2)(4,3))-12(2,2)-2((2,2)(4,3))-3(2,3)-12(2,2)-2(1,3)-3(1,3), б — РБ-211 — М3(2,3)-2(4,3)-12(0,0)-2(4,3)-12(0,0)-1(1,3)-12(2,2)-2(2,2)-12(0,0)-3(2,3)

Указанные массивы дают возможность организовывать циклы при вычислениях матриц, определяющих положения звеньев, а так же расчет пересечений объемных примитивов с запретными зонами. Одним из преимуществ разработанного метода представления геометрических моделей кинематических цепей, является возможность более точного задания пространственной конфигурации манипуляторов с помощью использования большого количества узловых точек и различного положения объемных примитивов относительно конструктивной плоскости ПСК. Другим достоинством является разработка универсальных программных модулей, позволяющих проводить виртуальную оценку движений робототехнических систем, имеющих сложную структуру кинематических цепей без ограничений на значения параметров nm, n и r (при этом 2 r 6).

Кобринский, А. А. Манипуляционные системы роботов [Текст] / А. А. Кобринский, А. Е. Кобринский М.: Наука, 1985. 344 с.

Сидоренко, В. С. Мехатронный измерительный модуль параметров исполнительных движений станочных систем [Электронный ресурс] / В. С. Сидоренко, Ле Чунг Киен, Д. Д. Дымочкин // «Инженерный вестник Дона», 2013, № 3. Режим доступа: http.ivdon.ru/magazine/archive/n3y2013/1747 (доступ свободный) Загл. с экрана. Яз. рус.

Притыкин, Ф. Н. Методы и технологии виртуального моделирования движений адаптивных промышленных роботов с использованием средств компьютерной графики [Текст] / Ф. Н. Притыкин // Мехатроника, автоматизация, управление, 2011. № 6. С. 34−41.

Притыкин, Ф. Н. Анализ показателей маневренности механизмов манипуляторов, имеющих различную структуру кинематических цепей [Текст] / Ф. Н. Притыкин, Е. А. Чукавов // Мехатроника, автоматизация, управление. 2013. № 1. С. 35−39.

Зенкевич, С. Л., Управление роботами. Основы управления манипуляционными робототехническими системами [Текст] / С. Л. Зенкевич, А. С. Ющенко. М: МВТУ, 2000. — 400 с.