Научная статья на тему 'МАТЕМАТИЧЕСКАЯ МОДЕЛЬ, АЛГОРИТМ ФОРМИРОВАНИЯ ВЕКТОРА СОСТОЯНИЯ И ТЕХНИЧЕСКАЯ РЕАЛИЗАЦИЯ МНОГОКООРДИНАТНОГО ЗАДАЮЩЕГО ОРГАНА ВНУТРИКАМЕРНЫХ МАНИПУЛЯТОРОВ'

МАТЕМАТИЧЕСКАЯ МОДЕЛЬ, АЛГОРИТМ ФОРМИРОВАНИЯ ВЕКТОРА СОСТОЯНИЯ И ТЕХНИЧЕСКАЯ РЕАЛИЗАЦИЯ МНОГОКООРДИНАТНОГО ЗАДАЮЩЕГО ОРГАНА ВНУТРИКАМЕРНЫХ МАНИПУЛЯТОРОВ Текст научной статьи по специальности «Строительство и архитектура»

CC BY
41
11
i Надоели баннеры? Вы всегда можете отключить рекламу.
Ключевые слова
МНОГОСТЕПЕННОЙ МАНИПУЛЯТОР / ГЕРМЕТИЧНАЯ КАМЕРА / ЗАДАЮЩИЙ ОРГАН / ДЖОЙСТИК

Аннотация научной статьи по строительству и архитектуре, автор научной работы — Носиков Максим Владимирович, Войнов Игорь Вячеславович, Морозов Борис Александрович

Цель исследования: разработка математической модели и алгоритма формирования вектора состояния многокоординатного задающего органа дельта-типа для осуществления управления манипуляторами с человеком-оператором в контуре управления. Методы исследования. В работе рассмотрены существующие методы дистанционного управления многостепенными манипуляторами (специального назначения) с человеком-оператором в контуре управления, выявлены достоинства и недостатки существующих решений. При этом поставлена задача синтеза задающего органа для обеспечения управления манипулятором в пространстве одной рукой. На сегодняшний день на предприятиях атомной промышленности широко применяются герметичные камеры, в которых устанавливаются электромеханические манипуляторы копирующего типа. В состав таких манипуляторов входят исполнительные органы, устанавливаемые непосредственно в герметичной камере, и их кинематически подобные задающие органы. Оператор вручную перемещает задающий орган, траектория движения звеньев которого повторяется внутри камеры исполнительным органом манипулятора. С учетом физического и морального устаревания данного оборудования требуется введение современных подходов к построению человеко-машинных интерфейсов. В работе предложена математическая модель вычисления вектора состояния (линейных и угловых координат) задающего органа дельта-типа по измеряемой информации об относительном угловом положении в его вращательных кинематических парах. Результаты исследования. Синтезирован алгоритм вычисления координат рукоятки задающего органа на основе априорной информации о взаимном расположении элементов дельта-механизма. С учетом расположенных на рукоятке задающего органа дополнительных дискретных и пропорциональных каналов управления предложенные алгоритм и его практическая реализация позволяют вводить дополнительные режимы управления манипулятором. Заключение. К основным результатам работы относится математическая модель и алгоритм формирования вектора состояния задающего органа дельта-типа, позволяющего оператору осуществлять формирование векторов линейной и угловой скорости движения схвата многостепенного манипулятора одной рукой. Техническая реализация задающего органа и алгоритма, а также опытная эксплуатация задающего органа в составе манипуляционной системы показали высокую эффективность предложенных решений.

i Надоели баннеры? Вы всегда можете отключить рекламу.

Похожие темы научных работ по строительству и архитектуре , автор научной работы — Носиков Максим Владимирович, Войнов Игорь Вячеславович, Морозов Борис Александрович

iНе можете найти то, что вам нужно? Попробуйте сервис подбора литературы.
i Надоели баннеры? Вы всегда можете отключить рекламу.

MATHEMATICAL MODEL, STATE VECTOR CALCULATION ALGORITHM AND REALIZATION OF MULTI-AXES CONTROL STICK FOR INTRACHAMBER MANIPULATORS

The purpose of the study is a development of a mathematical model and an algorithm for the calculation of the state vector of a multi-axes delta-type control joystick for moving special purposes arm manipulators by a human operator in the loop. Research methods. The paper considers the existing methods of remote control of intrachambers special purpose arm manipulators with a human operator in the control loop, identifies the advantages and disadvantages of existing solutions. The task of synthesizing the optimal control stick to ensure driving of the manipulator in 3D-space was set. Today, nuclear industry enterprises widely use hermetic chambers in which copy-type electromechanical manipulators are installed. The manipulation system includes an arm manipulator installed directly in a sealed chamber, and its kinematically similar control arm. The operator manually moves the control arm, the trajectory of which is repeated inside the chamber by the arm manipulator. Taking into account moral and physical obsolescence, the introduction of modern approaches to the human-machine interaction is required. The paper proposes a mathematical model for calculation the state vector (linear and angular coordinates) of a delta-type control stick from measured information about the relative angular position in its rotational kinematic pairs. Results of the study. An algorithm for calculating the coordinates of the handle of the control stick is synthesized based on a priori information about the relative position of the elements in the delta-mechanism. Taking into account the additional discrete and proportional controls located on the handle of the control stick, the proposed algorithm and its practical implementation make it possible to introduce effective manipulator control modes. Conclusion. The main results of the work include a mathematical model and an algorithm for generating the state vector of the delta-type control stick, which allows the operator to form the linear and angular velocity vectors of the arm manipulator and its gripper movement by one hand. The technical implementation of the control stick and algorithm, as well as its test operation with a dual arm manipulator system, showed the high efficiency of the proposed solutions.

Текст научной работы на тему «МАТЕМАТИЧЕСКАЯ МОДЕЛЬ, АЛГОРИТМ ФОРМИРОВАНИЯ ВЕКТОРА СОСТОЯНИЯ И ТЕХНИЧЕСКАЯ РЕАЛИЗАЦИЯ МНОГОКООРДИНАТНОГО ЗАДАЮЩЕГО ОРГАНА ВНУТРИКАМЕРНЫХ МАНИПУЛЯТОРОВ»

Управление в технических системах Control in technical systems

Научная статья

УДК 007.51:007.52:681.516:681.518 DOI: 10.14529/ctcr230102

МАТЕМАТИЧЕСКАЯ МОДЕЛЬ, АЛГОРИТМ ФОРМИРОВАНИЯ ВЕКТОРА СОСТОЯНИЯ И ТЕХНИЧЕСКАЯ РЕАЛИЗАЦИЯ МНОГОКООРДИНАТНОГО ЗАДАЮЩЕГО ОРГАНА ВНУТРИКАМЕРНЫХ МАНИПУЛЯТОРОВ

М.В. Носиков, nosikovmv@susu.ru, https://orcid.org/0000-0001-9361-2900 И.В. Войнов, voinoviv@susu.ru, https://orcid.org/0000-0002-7926-8610 Б.А. Морозов, morozovba@susu.ru

Южно-Уральский государственный университет, филиал в г. Миассе, Миасс, Россия

Аннотация. Цель исследования: разработка математической модели и алгоритма формирования вектора состояния многокоординатного задающего органа дельта-типа для осуществления управления манипуляторами с человеком-оператором в контуре управления. Методы исследования. В работе рассмотрены существующие методы дистанционного управления многостепенными манипуляторами (специального назначения) с человеком-оператором в контуре управления, выявлены достоинства и недостатки существующих решений. При этом поставлена задача синтеза задающего органа для обеспечения управления манипулятором в пространстве одной рукой. На сегодняшний день на предприятиях атомной промышленности широко применяются герметичные камеры, в которых устанавливаются электромеханические манипуляторы копирующего типа. В состав таких манипуляторов входят исполнительные органы, устанавливаемые непосредственно в герметичной камере, и их кинематически подобные задающие органы. Оператор вручную перемещает задающий орган, траектория движения звеньев которого повторяется внутри камеры исполнительным органом манипулятора. С учетом физического и морального устаревания данного оборудования требуется введение современных подходов к построению человеко-машинных интерфейсов. В работе предложена математическая модель вычисления вектора состояния (линейных и угловых координат) задающего органа дельта-типа по измеряемой информации об относительном угловом положении в его вращательных кинематических парах. Результаты исследования. Синтезирован алгоритм вычисления координат рукоятки задающего органа на основе априорной информации о взаимном расположении элементов дельта-механизма. С учетом расположенных на рукоятке задающего органа дополнительных дискретных и пропорциональных каналов управления предложенные алгоритм и его практическая реализация позволяют вводить дополнительные режимы управления манипулятором. Заключение. К основным результатам работы относится математическая модель и алгоритм формирования вектора состояния задающего органа дельта-типа, позволяющего оператору осуществлять формирование векторов линейной и угловой скорости движения схвата многостепенного манипулятора одной рукой. Техническая реализация задающего органа и алгоритма, а также опытная эксплуатация задающего органа в составе манипуляционной системы показали высокую эффективность предложенных решений.

Ключевые слова: многостепенной манипулятор, герметичная камера, задающий орган, джойстик

Для цитирования: Носиков М.В., Войнов И.В., Морозов Б.А. Математическая модель, алгоритм формирования вектора состояния и техническая реализация многокоординатного задающего органа внутрикамерных манипуляторов // Вестник ЮУрГУ. Серия «Компьютерные технологии, управление, радиоэлектроника». 2023. Т. 23, № 1. С. 19-30. DOI: 10.14529/ctcr230102

© Носиков М.В., Войнов И.В., Морозов Б.А., 2023

Original article

DOI: 10.14529/ctcr230102

MATHEMATICAL MODEL, STATE VECTOR CALCULATION ALGORITHM AND REALIZATION OF MULTI-AXES CONTROL STICK FOR INTRACHAMBER MANIPULATORS

M.V. Nosikov, nosikovmv@susu.ru, https://orcid.org/0000-0001-9361-2900 I.V. Voinov, voinoviv@susu.ru, https://orcid.org/0000-0002-7926-8610 B.A. Morozov, morozovba@susu.ru South Ural State University, Miass, Russia

Abstract. The purpose of the study is a development of a mathematical model and an algorithm for the calculation of the state vector of a multi-axes delta-type control joystick for moving special purposes arm manipulators by a human operator in the loop. Research methods. The paper considers the existing methods of remote control of intrachambers special purpose arm manipulators with a human operator in the control loop, identifies the advantages and disadvantages of existing solutions. The task of synthesizing the optimal control stick to ensure driving of the manipulator in 3D-space was set. Today, nuclear industry enterprises widely use hermetic chambers in which copy-type electromechanical manipulators are installed. The manipulation system includes an arm manipulator installed directly in a sealed chamber, and its kinematically similar control arm. The operator manually moves the control arm, the trajectory of which is repeated inside the chamber by the arm manipulator. Taking into account moral and physical obsolescence, the introduction of modern approaches to the human-machine interaction is required. The paper proposes a mathematical model for calculation the state vector (linear and angular coordinates) of a delta-type control stick from measured information about the relative angular position in its rotational kinematic pairs. Results of the study. An algorithm for calculating the coordinates of the handle of the control stick is synthesized based on a priori information about the relative position of the elements in the delta-mechanism. Taking into account the additional discrete and proportional controls located on the handle of the control stick, the proposed algorithm and its practical implementation make it possible to introduce effective manipulator control modes. Conclusion. The main results of the work include a mathematical model and an algorithm for generating the state vector of the delta-type control stick, which allows the operator to form the linear and angular velocity vectors of the arm manipulator and its gripper movement by one hand. The technical implementation of the control stick and algorithm, as well as its test operation with a dual arm manipulator system, showed the high efficiency of the proposed solutions.

Keywords: arm manipulator, sealed chamber, delta-mechanism, control stick

For citation: Nosikov M.V., Voinov I.V. Morozov B.A. Mathematical model, state vector calculation algorithm and realization of multi-axes control stick for intrachamber manipulators. Bulletin of the South Ural State University. Ser. Computer Technologies, Automatic Control, Radio Electronics. 2023;23(1):19-30. (In Russ.) DOI: 10.14529/ctcr230102

Введение

В технологических процессах переработки отработанного ядерного топлива (ОЯТ) и в аналитических лабораториях соответствующих производств используются герметичные камеры, внутри которых исполнительными органами различных манипуляторов перемещается специальная технологическая тара с жидкими, сыпучими или твердыми радиоактивными материалами. Управление движением манипулятора осуществляется человеком-оператором дистанционно: посредством кинематически подобных задающих органов (ЗО) и системы управления манипулятором, соединенной с исполнительным органом (ИО) механической или электрической связью [1, 2].

В настоящее время наиболее широкое применение для решения поставленных задач на предприятиях атомной промышленности нашли электромеханические манипуляторы МЭМ-10 [3]. Исполнительный орган манипулятора содержит 6 степеней подвижности и размещается внутри герметичной камеры, а кинематически подобный задающий орган с системой управления - в ра-

бочей зоне оператора. К недостаткам данного манипулятора относятся значительные люфты в зубчатых передачах манипуляторов, что снижает точность операций взятия-перемещения объектов манипулирования, необходимость определенных физических усилий человека-оператора при перемещении задающего органа, а также использование устаревшей и давно не выпускаемой системы типа «сельсин-датчик - сельсин-приемник». Серийно выпускаемые промышленные роботы-манипуляторы (КиКА и аналогичные) фактически неприменимы к выполнению задач внутри герметичных камер, в первую очередь из-за низкой радиационной стойкости и их массо-габаритных характеристик.

На рис. 1 представлена типовая схема работы с радиоактивными материалами с использованием электромеханического копирующего манипулятора с кинематически подобным задающим органом и оператором в контуре управления.

Рис. 1. Копирующий манипулятор в герметичной камере Fig. 1. Copying manipulator in a hotcell

Кроме очевидных достоинств ЗО копирующего типа обладают и рядом недостатков:

1) конструктивная сложность как самого ЗО, так и передач ЗО-ИО;

2) необходимость механической фиксации промежуточных степеней подвижности ЗО при выполнении ряда операций;

3) значительные линейные перемещения ЗО, что в условиях ограниченных по площади рабочих мест операторов может быть помехой.

В связи с этим для построения современных систем управления многостепенными манипуляторами необходимо применять новые подходы и возможности современной элементной базы, при этом исходить:

1) из двигательных возможностей оператора (его кинематических и силомоментных ограничений) и возможностей расположения пульта управления относительно герметичной камеры;

2) числа степеней подвижности объекта управления - исполнительного органа манипулятора;

3) режимов управления объектом управления, способов переключения между режимами;

4) необходимости и технической возможности реализации дополнительных каналов человеко-машинного интерфейса (дополнительные задающие органы, средства индикации и т. п.).

В ряде отраслей промышленности, а также в медицине нашли применение задающие органы типа «джойстик» [4-7]. Специфические условия эксплуатации манипуляторов в атомной промышленности не позволяют использовать данные наработки непосредственно при работе с радиоактивными материалами.

В общем случае при использовании ЗО типа «джойстик» существуют три основных метода управления манипулятором: управление по вектору скорости (УВСК), управление по вектору силы (УВС), управление по положению (УП) [8, 9].

Необходимо принять во внимание, что в связи с ограниченным диапазоном перемещений ЗО управление внутрикамерным манипулятором обычно выполняется по вектору скорости (УВСК), а управление по вектору положения при необходимости осуществляется в ограниченных пространственных зонах.

Для работы по методу УВС в состав ЗО должны входить силовые и/или моментные исполнительные приводы, прикладывающие соответствующие силовые воздействия к рукоятке ЗО, в составе манипулятора - датчики моментных усилий в сочленениях манипулятора или датчики линейных сил, возникающих в схвате манипулятора под действием нагрузки или перемещений. Техническая реализация ЗО для данного метода достаточно трудоемка, и в практических конструкциях манипуляторов применяют методы УВСК и УП.

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

Для обеспечения решения полного комплекса транспортных задач (выход рабочего инструмента в заданную точку зоны обслуживания манипулятора под заданным углом) исполнительный орган манипулятора должен иметь 6 степеней подвижности [3] (кинематических сочленений вращательного или поступательного типа). Соответственно, система управления манипулятора должна обеспечивать управление этими сочленениями через соответствующие приводы и управление рабочим инструментом, в частности схватом манипулятора [10-12].

Учитывая эргономику рабочего места оператора герметичных камер и возможности человека оперировать двумя руками, был разработан манипулятор модели МР-48 [13], система управления которого реализована на двух джойстиках с тремя и четырьмя степенями подвижности соответственно. Манипулятор успешно прошел испытания в реальных условиях эксплуатации.

В процессе опытной эксплуатации МР-48 был сформулирован круг задач, для решения которых требуется обеспечить управление всеми степенями подвижности и рабочим инструментом манипулятора одной рукой человека-оператора. Таковой, в частности, является задача управления внутрикамерным манипулятором, размещенным на подвижном основании (рис. 2).

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

Рис. 2. Внутрикамерный манипулятор на подвижном основании с дистанционным управлением от джойстиков Fig. 2. Hotcell manipulator on movable base with joysticks distance control

Предлагается решение указанной задачи с помощью задающего органа, выполненного по кинематической схеме дельта-типа, внешний вид которого приведен на рис. 3.

На рис. 3 обозначены:

1 - неподвижное основание;

2 - выходной информационный разъем;

3 - шарнирные подвесы и датчики углового положения промежуточных тяг (рычагов);

4 - противовесы;

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

6 - датчики углового положения рукоятки (ориентации рукоятки);

7 - управляющая рукоятка;

8 - дополнительные дискретные и пропорциональные каналы управления.

В предложенной кинематической схеме оператор имеет возможность независимого линейного перемещения рукоятки вдоль осей связанной с основанием декартовой системы координат OXYZ и, независимо от линейного положения, ее ориентирования в полулирном подвесе на углы а, р, у . Диапазоны линейного перемещения определяются конструкцией шарнирных подвесов и длинами тяг (поз. 3, 5, рис. 3), аналогичным образом конструкцией полулирного подвеса определяются диапазоны углов ориентации рукоятки. Оператор пальцами кисти имеет возможность воздействия на дополнительные пропорциональные и дискретные каналы управления, размещенные непосредственно на рукоятке. Выходной вектор состояния данного ЗО можно представить следующим образом:

Рис. 3. Внешний вид многостепенного джойстика дельта-типа Fig. 3. Structure and parts of delta-type joystick

O

OUT

'(a, P, Yf ^ ( - У, z f

O O

PC

DC

( Fi ( qa, qp, fy) ^ f2 ( qfl, qj 2, qj з )

O O

PC

DC

(i)

где OOUT (t) - выходной вектор состояния задающего органа;

Ope - вектор состояния дополнительных пропорциональных каналов управления, размещенных на рукоятке;

Odc - вектор состояния дополнительных дискретных каналов управления, размещенных на рукоятке;

a, р, у - углы ориентации рукоятки;

х, y, z - координаты линейного положения рукоятки относительно основания;

qa, qp, qy - сигналы (информация) от датчиков углового положения рукоятки (поз. 6, рис. 3);

qji, qj2, qj3 - сигналы (информация) от датчиков углового положения, расположенных на

основании ЗО (поз. 3, рис. 3);

F], F2 - отображения множеств информационных сигналов датчиков углового положения в векторы выходных координат ЗО.

Введем следующие обозначения элементов дельта-механизма (рис. 4): L = OA1 = OA2 = OA3; L2 = A1B1 = A2B2 = A3B3 ; L3 = B1D = B2D = B3D.

Задача определения линейного положения рукоятки джойстика в пространстве сводится к нахождению координаты точки D при заданных длинах звеньев L], L2, L3 и углах поворотов шарниров qjl, qj 2, q^.

Используя метод трилатерации, сформируем алгоритм вычисления координаты точки D. Трехмерная проблема трилатерации представляет собой нахождение координат точки пересечения трех сфер. ПустьBy (xy, y1, z1), B2 (x2, y2, z2), B3 (x3, y3, z3) - центры исходных сфер;

L3 = ByD = B2D = B3D - радиусы сфер; D(x, y, z) - искомая точка. По известным длинам звеньев Ly, L2, L3, измеренным углам шарниров qjy, qj2, qj3 и начальному условию, что основание ^i^2A3 является равносторонним треугольником, определим координаты центров сфер By, B2, B3 (формула (2), рис. 4, 5).

x = Ly + L2 cos(qji); y = 0; zy = L2 sin (qn);

Xo = -

X, =-

(L + L 2 eos (qj 2 )) sin ^; J2 =(Li + L 2 cos (q}2 )) cos ^ (L + L2 eos(qj3))sin^^jj; J3 =-(Li + L2 eos(qj3))

Zo =

2

eos —

Z=

3

L2sin (qj 2);

L2sin (qj3).

(2)

Рис. 4. Геометрическая модель многостепенного джойстика дельта-типа Fig. 4. Geometric model of delta-type joystick

д Bl x

Рис. 5. Проекции точек A¡,B¡ на плоскости XY, XZ Fig. 5. Projections of points Ai,Bi to planes XY, XZ

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

Найдём точку - центр окружности, по которой пересекаются первые две сферы. Посколь-

ку радиусы сфер равны, то точка В

12

X + x2 У + У2 -1 + -2

2

2

2

iНе можете найти то, что вам нужно? Попробуйте сервис подбора литературы.

является серединой отрезка ВВ .

Искомая точка D лежит в плоскости, проходящей через В^ и перпендикулярной В1В2 . Для неё выполняется уравнение данной плоскости

x--

^)(X2 - Xl) + [ Л - ^ ]( Л2 - Л) + [ Z - ^ )(-2 - -О

(z2 - - ) = 0

или иначе

(X2 - Xl) + У (У2 - У1) + - (—2 - -l) = 2 (X2 - X12 + Л2 - Л12 + -2 - -12).

(3)

(4)

Аналогичное уравнение выводится для координат точки В^ - центра окружности и середины отрезка В1В3:

x(x3 -xi) + У(Уз -У1) + -(—з - -1) =1 (хз2 - X12 + Уз -У2 + -з2 - -12).

(5)

Пересечение двух полученных плоскостей даёт прямую, перпендикулярную плоскости треугольника В1В2В3 . Пересечение данной прямой с плоскостью треугольника даёт точку Р - основание перпендикуляра из точки D на плоскость треугольника. Дополнив систему уравнением плоскости треугольника, получим линейную систему уравнений для координат точки Р. Уравнение плоскости треугольника:

[(Уз -У1)(г2 -ч)-(У2 -У1)(гз -г1)](х-х0 +

+ [(Ч3 - г1 )(Х2 - Х1 ) - (г2 - г1 )(Х3 - Х1 ) ](У - У1) +

+ [(Х3 - Х1)(У2 - У1) - (Х2 - Х1)(Уз - У1)](г - г1) = 0. (6)

Преобразуем уравнение (6):

[(Уз - У1 )(г2 - г1 ) -(У2 - У1 )(Ч - г1 ) ]Х + [(Ч3 - г1)(Х2 - Х1 ) - (г2 - г1 )(Х3 - Х1 ) ]У +

+ [(Х3 - Х1 )(У2 - У1 ) -(Х2 - Х1)(Уз - У1)]г = [(Уз - У1)(г2 - ч)- (У2 - У1)(гз - г1) ]Х1 +

+ [(Ч3 - г1)(Х2 - Х1) - (г2 - г1)(Х3 - Х1) ]У1 + [(Х3 - Х1)(У2 - У1) - (Х2 - Х1)(Уз - У1)]г1. (7)

Координаты точки Р находятся как решение системы трех линейных уравнений (4), (5), (7) с тремя неизвестными х, у, г . Данную систему можно представить в матричном виде АХ = В . Введем обозначение:

Ааг1 = а1 - а1, а е^Х, у, г}, г е{2, з}. Тогда:

A =

Ax: Ax

21

31

Ау: АУ;

21

31

Az. А-

21

31

1АУ31А-21 - АУ21 Az31 А-31 Ax21 - Az21 Ax31 Ах31АУ21 - Ах21АУ31.

X = (x y z) ;

^ 1 / 2 2. 2 2.2 2 \ - (x2 - x1 + У2 - У1 + z2 - -1 )

B

1 / 2 2.2 2,2 2 \

2 (x3 - x1 + У3 - У1 + -3 - -1)

( АУ31 Az21 - АУ21А-31 ) + ( А-31 Ax21 - Az21 Ax31 ) + (Ax31 АУ21 - Ax21Ay31 )

Обозначим найденные координаты точки Р как х0, у0, 20 . Тогда координаты точек пересечения трех сфер:

х = хо + к ((Уз - у 1 )(г2 - 21)-(У2 - У1)(2з - 21));

У = Уо + к ((23 - 21)(х2 - х 1 )-(22 - 2 1 )(х3 - х 1)); (8)

z = z0 +

к (( Хз - X1)( J2 - у 1)-( Х2 - X1 )(j3 - J1)).

к = ±

- PB\

2 S

(9)

b1b 2 b 3

где SBlB2В3 - площадь треугольника ВХВ2В3.

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

Полученные координаты дают составляющую (х, у, 2)Т в векторе состояния ЗО (1). Ориентация рукоятки в пространстве (углы а, Р, у) вычисляется методом прямого измерения и преобразования сигналов qa, qp, qу датчиков углового положения, установленных в полулирном подвесе. В результате вычисленный полный вектор состояния ЗО (1) позволяет реализовать метод управления манипулятором (схватом манипулятора либо отдельными его степенями подвижности) по вектору скорости либо в позиционном режиме, оператор при этом осуществляет управление одной рукой. Дополнительные каналы управления (пропорциональные или дискретные), размещенные на рукоятке задающего органа, могут быть использованы для задания (переключения) специальных режимов движения манипулятора, управления положением и ориентацией подвижного основания, управления внутрикамерным технологическим оборудованием.

Заключение

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

Рис. 6. Манипуляционная система МР-64 (а) и ее задающий орган (b) Fig. 6 Manipulator system MR-64 (a) and its control delta-joystick (b)

Алгоритм реализован в составе опытного образца манипуляционной системы МР-64 (рис. 6а) [14]. В состав манипуляционной системы входит исполнительный орган, пульт управления с сен-

2

сорным экраном, задающий орган дельта-типа. В ходе отладки, испытаний и опытной эксплуатации манипуляционной системы подтверждены предложенные алгоритмические решения и возможность эффективного (с точки зрения затрат времени и точности) выполнения операций одной рукой (рис. 6b).

С целью анализа эффективности действий оператора при выполнении технологических операций, соответствия характера движений манипулятора оптимальным траекториям, а также дальнейшей настройки и адаптации системы человеко-машинного интерфейса и системы управления в целом данные о векторах состояния манипуляторов сдвоенной манипуляционной системы, векторах состояния задающих органов передаются в базу данных системы тренажерного обучения и анализа действий операторов, реализованной на основе фрэймворка ROS [15], структура которой описана в [16, 17].

Список литературы

1. Sturges R.H. Practical field robotics: A systems approach. Wiley, 2015. 479 p. DOI: 10.1002/9781118941171, ISBN 978-1-118-94114-0.

2. Field and Service Robotics: Results of the 8th International Conference / K. Yoshida, S. Tadoko-ro (Eds.). Springer, 2014. (Springer Tracts in Advanced Robotics. Vol. 92). DOI: 10.1007/978-3-64240686-7, ISBN 978-3-642-40685-0.

3. Юревич Е.И. Основы робототехники. СПб.: БХВ-Петербург, 2005. 416 с. ISBN 5-94157473-8.

4. Dynamic and interactive generation of object handling behaviors by a small humanoid robot using a dynamic neural network model / M. Ito, K. Noda, Y. Hoshino, J. Tani // Neural Networks. 2006. Vol. 19 (3). P. 323-337. DOI: 10.1016/j.neunet.2006.02.007

5. Human-Robot Interaction / N. Sarkar (Ed.). Vienna, Austria: I-Tech Education and Publishing, 2007. DOI: 10.5772/51, ISBN 978-3-902613-13-4.

6. Brain-controlled interfaces: Movement restoration with neural prosthetics / A.B. Schwartz, X.T. Cui, D.J. Weber, D.W. Moran // Neuron. 2006. Vol. 52, iss. 1. P. 205-220. DOI: 10.1016/j.neuron.2006.09.019

7. Nagata F., Watanabe K. Controller design for industrial robots and machine tools: Applications to manufacturing processes. Woodhead Publishing Limited, 2013. 357 p. ISBN 978-0-85709462-9.

8. Montesano L., Minguez J., Montano L. Modeling dynamic scenarios for local sensor-based motion planning // Autonomous Robots. 2008. Vol. 25, no. 3. P. 231-251. DOI: 10.1007/s10514-008-9092-9

9. Springer Handbook of Robotics / B. Siciliano, O. Khatib (Eds.). Springer, 2016. 2155 p. ISBN 978-3319325507.

10. Marghitu D.B. Mechanisms and Robots Analysis with MATLAB. Springer, 2009. 479 p. DOI: 10.1007/978-1-84800-391-0, ISBN 978-1-84800-390-3.

11. New advances in Mechanisms, Mechanical Transmissions and Robotics. Proceedings of The Joint International Conference of the XII International Conference on Mechanisms and Mechanical Transmissions (MTM) and the XXIII International Conference on Robotics (Robotics '16). Springer International Publishing, 2016. 472 p. DOI: 10.1007/978-3-319-45450-4, ISBN 978-3-31945449-8.

12. MT 200 TAO Electrically Assisted, Computer-Aided Master-Slave Manipulator. URL: https://www.lacalhene.com/int/applications-products/remote-manipulation/mt200-tao/ (дата обращения: 30.06.2022).

13. Патент RU 172431 U1, МПК B25J 1/00, B25J 9/18, B25J 13/02. Манипулятор МР-48 для атомной промышленности / И.В. Войнов, И.Ф. Круглов, Б.А. Морозов и др. 2016.

14. Патент RU 209596 U1, МПК B25J 21/00. Манипуляционная система для герметичных камер / И.В. Войнов, И.Ф. Круглов, Б.А. Морозов, М.В. Носиков. 2021.

15. Newman W.S. A Systematic Approach to Learning Robot Programming with ROS. CRC Press, 2018. 531 p. ISBN 978-1498777827.

16. Nosikov M.V. Architecture of Human-controlled Arm Manipulator Operator Training System // Proceedings of the Global Smart Industry Conference (GloSIC). Chelyabinsk, 2018. P. 1-6. DOI: 10.1109/GloSIC.2018.8570118

17. Носиков М.В. Архитектура тренажерной системы подготовки операторов радиационно-стойких манипуляторов // Вестник ЮУрГУ. Серия «Компьютерные технологии, управление, радиоэлектроника». 2019. Т. 19, № 2. С. 38-54. DOI: 10.14529/ctcr190204

References

1. Sturges R.H. Practical field robotics: A systems approach. Wiley; 2015. 479 p. ISBN 978-1-11894114-0. DOI: 10.1002/9781118941171

2. Yoshida K., Tadokoro S. (Eds.). Field and Service Robotics: Results of the 8th International Conference (Springer Tracts in Advanced Robotics. Vol. 92). Springer; 2014. DOI: 10.1007/978-3-64240686-7, ISBN: 978-3-642-40685-0.

3. Yurevich E.I. Osnovy robototekhniki [Robotics basics]. St. Petersburg: BKhV-Peterburg, 2005. 368 p. (In Russ.). ISBN 5-941574-73-8.

4. Ito M., Noda K., Hoshino Y., Tani J. Dynamic and interactive generation of object handling behaviors by a small humanoid robot using a dynamic neural network model. Neural Networks. 2006;19(3):323-337. DOI: 10.1016/j.neunet.2006.02.007

5. Sarkar N. Human-Robot Interaction. Vienna, Austria: I-Tech Education and Publishing, 2007. DOI: 10.5772/51, ISBN 978-3-902613-13-4.

6. Schwartz A.B., Cui X.T., Weber D.J., Moran D.W. Brain-controlled interfaces: Movement restoration with neural prosthetics. Neuron. 2006;52(1):205-220. DOI: 10.1016/j.neuron.2006.09.019

7. Nagata F., Watanabe K. Controller design for industrial robots and machine tools: Applications to manufacturing processes. Woodhead Publishing Limited, 2013. 357 p. ISBN 978-0-85709-462-9.

8. Montesano L., Minguez J., Montano L. Modeling dynamic scenarios for local sensor-based motion planning. Autonomous Robots. 2008;25(3):231-251. DOI: 10.1007/s10514-008-9092-9

9. Siciliano B., Khatib O. (Eds.). Springer Handbook of Robotics. Springer; 2016. 2155 p. ISBN 978-3319325507.

10. Marghitu D.B. Mechanisms and Robots Analysis with MATLAB. Springer; 2009. 479 p. DOI: 10.1007/978-1-84800-391-0, ISBN 978-1-84800-390-3.

11. New advances in Mechanisms, Mechanical Transmissions and Robotics. Proceedings of The Joint International Conference of the XII International Conference on Mechanisms and Mechanical Transmissions (MTM) and the XXIII International Conference on Robotics (Robotics '16). Springer International Publishing; 2016. 472 p. DOI: 10.1007/978-3-319-45450-4, ISBN 978-3319-45449-8.

12. MT 200 TAO Electrically Assisted, Computer-Aided Master-Slave Manipulator. Available at: https://www.lacalhene.com/int/applications-products/remote-manipulation/mt200-tao/ (accessed 30.06.2022).

13. Voynov I.V., Kruglov I.F., Morozov B.A., Kazantsev A.M., Nosikov M.V. Manipulyator MR-48 dlya atomnoy promyshlennosti [Manipulator MR-48 for nuclear industry]. Patent RU 172431 U1, 2016. (In Russ.)

14. Voynov I.V., Kruglov I.F., Morozov B.A., Nosikov M.V. Manipulyatsionnaya sistema dlya germetichnykh kamer [Manipulator system for sealed chambers]. Patent RU 209596 U1, 2021. (In Russ.)

15. Newman W.S. A Systematic Approach to Learning Robot Programming with ROS. CRC Press; 2018. 531 p. ISBN 978-1498777827.

16. Nosikov M.V. Architecture of Human-controlled Arm Manipulator Operator Training System. In: Proceedings of the Global Smart Industry Conference (GloSIC). Chelyabinsk; 2018. P. 1-6. DOI: 10.1109/GloSIC.2018.8570118

17. Nosikov M.V. The Architecture of Human-Controlled Arm Manipulator Operator Training System. Bulletin of the South Ural State University. Ser. Computer Technologies, Automatic Control, Radio Electronics. 2019;19(2):38-53. (In Russ.) DOI: 10.14529/ctcr190204

Информация об авторах

Носиков Максим Владимирович, канд. техн. наук, доц. кафедры автоматики, ЮжноУральский государственный университет, филиал в г. Миассе, Миасс, Россия; nosikovmv@susu.ru.

Войнов Игорь Вячеславович, д-р техн. наук, проф., проф. кафедры автоматики, ЮжноУральский государственный университет, филиал в г. Миассе, Миасс, Россия; voinoviv@susu.ru.

Морозов Борис Александрович, заведующий лабораторией робототехники, Южно-Уральский государственный университет, филиал в г. Миассе, Миасс, Россия; morozovba@susu.ru.

Information about the authors

iНе можете найти то, что вам нужно? Попробуйте сервис подбора литературы.

Maxim V. Nosikov, Cand. Sci. (Eng.), Ass. Prof. of the Automation Department, South Ural State University, Miass, Russia; nosikovmv@susu.ru.

Igor V. Voinov, Dr. Sci. (Eng.), Prof., Prof. of the Automation Department, South Ural State University, Miass, Russia; voinoviv@susu.ru.

Boris A. Morozov, Head of Robotics Laboratory, South Ural State University, Miass, Russia; morozovba@susu.ru.

Статья поступила в редакцию 12.04.2022

The article was submitted 12.04.2022

i Надоели баннеры? Вы всегда можете отключить рекламу.