Научная статья на тему 'Разработка системы определения режима контактного взаимодействия звена ползающего робота с препятствием'

Разработка системы определения режима контактного взаимодействия звена ползающего робота с препятствием Текст научной статьи по специальности «Механика и машиностроение»

CC BY
65
7
i Надоели баннеры? Вы всегда можете отключить рекламу.
Ключевые слова
ПОЛЗАЮЩИЙ РОБОТ / ЗВЕНО РОБОТА / УПРАВЛЕНИЕ ТРЕНИЕМ / ПРЕПЯТСТВИЕ / РЕЖИМ КОНТАКТНОГО ВЗАИМОДЕЙСТВИЯ / SLIDING ROBOT / ROBOT LINK / FRICTION CONTROL / OBSTACLE / MODE OF CONTACT INERACTION

Аннотация научной статьи по механике и машиностроению, автор научной работы — Ворочаева Людмила Юрьевна, Савин Сергей Игоревич, Яцун Андрей Сергеевич

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

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

SYSTEM DEVELOPMENT FOR DEFINITION OF CONTACT INTERACTION MODE IN LINK OF SLIDING ROBOT WITH OBSTACLE

The paper is dedicated to the problems of a link motion in a sliding robot on a horizontal surface with obstacles. The motion of a robot link is under consideration in case when one of its bearings located in utmost points is fixed on the surface and the second slips, that is, a link moves on an arc of a circle, at that a robot itself changes its configuration. A distinguishing peculiarity and advantage of this work is that in it there is no consideration of a specific design circuit of a sliding robot with the definite link number and type of swing joints between them, but a link turn on the plane under condition of the presence of mobility rotating degree in a hinge connecting links and friction control in bearings is only considered. In the work there is offered a four-level system for motion control of a robot link on a surface with obstacles where each of them is modeled in a rectangular form. A system for the mode definition of a link contact with an obstacle is considered thoroughly, the following possible modes are emphasized: the interaction of utmost points of a link and an obstacle, the utmost point of the link with the point on an obstacle side, a certain point of a link with the utmost point of the obstacle, a link with the obstacle side and the absence of the contact of a link and an obstacle. For each of the modes mentioned there are written conditions for its occurrence and also a necessity of link motion updating in order to surmount obstacles (a set of regulations for a system operation) is defined. The information on updating necessity comes to a corresponding level of the control system and then to the system of robot driving gear control that allows realizing such a link motion which ensures overcoming obstacles. Key words: sliding robot, robot link, friction control, obstacle, mode of contact ineraction.

Текст научной работы на тему «Разработка системы определения режима контактного взаимодействия звена ползающего робота с препятствием»

УДК 621.865

DOI: 10.30987/article_5d6cbe42247be1.64247013

Л.Ю. Ворочаева, С.И. Савин, А.С. Яцун

РАЗРАБОТКА СИСТЕМЫ ОПРЕДЕЛЕНИЯ РЕЖИМА КОНТАКТНОГО ВЗАИМОДЕЙСТВИЯ ЗВЕНА ПОЛЗАЮЩЕГО РОБОТА С ПРЕПЯТСТВИЕМ

Разработан набор правил работы системы определения режима контакта звена ползающего робота с препятствием при движении звена по горизонтальной плоскости относительно неподвижной опоры и моделирования препятствия в форме прямоугольника. Определены условия возникнове-

ния различных режимов контакта, установлена необходимость корректировки движения звена в каждом из этих случаев.

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

L.Yu. Vorochaeva, S.I. Savin, A.S. Yatsun

SYSTEM DEVELOPMENT FOR DEFINITION OF CONTACT INTERACTION MODE IN LINK OF SLIDING ROBOT WITH OBSTACLE

The paper is dedicated to the problems of a link motion in a sliding robot on a horizontal surface with obstacles. The motion of a robot link is under consideration in case when one of its bearings located in utmost points is fixed on the surface and the second slips, that is, a link moves on an arc of a circle, at that a robot itself changes its configuration. A distinguishing peculiarity and advantage of this work is that in it there is no consideration of a specific design circuit of a sliding robot with the definite link number and type of swing joints between them, but a link turn on the plane under condition of the presence of mobility rotating degree in a hinge connecting links and friction control in bearings is only considered.

In the work there is offered a four-level system for motion control of a robot link on a surface with obstacles where each of them is modeled in a rectangular form. A system for the mode definition of a link

contact with an obstacle is considered thoroughly, the following possible modes are emphasized: the interaction of utmost points of a link and an obstacle, the utmost point of the link with the point on an obstacle side, a certain point of a link with the utmost point of the obstacle, a link with the obstacle side and the absence of the contact of a link and an obstacle. For each of the modes mentioned there are written conditions for its occurrence and also a necessity of link motion updating in order to surmount obstacles (a set of regulations for a system operation) is defined. The information on updating necessity comes to a corresponding level of the control system and then to the system of robot driving gear control that allows realizing such a link motion which ensures overcoming obstacles.

Key words: sliding robot, robot link, friction control, obstacle, mode of contact ineraction.

Введение

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

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

на биомеханических принципах, в статьях [4; 5] описывается движение змееподобных роботов на плоскости, учитывающее ограничения, накладываемые на скольжение устройства, а в [6] - движение без учета таких ограничений. Большое число статей посвящено изучению движения ползающих роботов по поверхностям с препятствиями [7; 8].

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

ляющих определять возможность преодоления препятствия и необходимость кор-

ректировки движения.

Описание ползающего робота и препятствия

Как было указано выше, ползающие роботы имеют большое число разнообразных конструкций, различающихся по числу звеньев и типам шарнирных соединений между ними. В данной работе не будем привязываться к конкретному объекту исследования, т.е. ползающему роботу с определенным числом звеньев и заданными шарнирными соединениями. Будем рассматривать звено ОО\ некоторого ползающего робота (рис. 1а), отличительной особенностью которого является расположение в точке О опорного элемента с управляемым коэффициентом трения, например аналогичного описанному в [9; \0], где коэффициент трения может принимать значения Л / за счет смены

^ Ш1п ^ тах

опорных поверхностей. Варьирование коэффициента трения позволяет данной опоре периодически фиксироваться на поверхности при /Шах. Звено ОО\ при этом движется по дуге окружности, радиус которой равен длине звена Ь, изменяя тем самым конфигурацию робота. Во второй

опоре звена - точке О\ - коэффициент трения равен Г , что позволяет ей скользить

по поверхности. На рис. 1а зафиксированная опора О обозначена как •, а подвижная 0\ как О. Пусть движение звена робота происходит в горизонтальной плоскости, точка О устройства совпадает с началом абсолютной системы координат Оху, г0 = (0 0)т . Звено робота располагается под углом ф, отсчитываемым против часовой стрелки от положительного направления оси Ох. Тогда определение координат любой точки звена требует введения матрицы поворота

í

T

Л

cos ф - sin ф v sin ф cos ф ) Радиус-вектор точки Oí

roi = TPooi , Pool = (L °)T> где p001 - относительный радиус-вектор в

системе координат, связанной со звеном робота.

а) б)

Рис. 1. Расчетная схема звена ползающего робота и препятствия (а) и диапазоны углов ф и а (б)

Встречающиеся на пути следования ползающего робота препятствия могут иметь различные форму и размеры. В данной работе ограничимся рассмотрением одного из наиболее часто встречающихся препятствий - имеющего в плоскости Оху форму прямоугольника. Препятствие АББЕ имеет размеры I х Ь, его положение на плоскости описывается радиусом-

вектором тА = (хА уА )т точки А и углом а

наклона стороны АЕ к оси Ох.

Радиусы-векторы остальных точек -вершин препятствия - определяются с учетом матрицы поворота ТА и относительных радиусов-векторов рАВ , рАО, рАЕ

вершин препятствия в системе координат

Ахлул :

T

Acos а - sin аЛ

v sin а cos а j

rb = TaP ab , P ab = (° bf, rd = TaP ad , Pad = (l b)T , re = TAP AE , P ae = (l °)T . Диапазоны изменения углов ориентации звена и препятствия на плоскости равны (рис. 1б):

Фе[Фи, Фк], (°^Фп)Л(Ф« <Фк)л(Фк /2), а е (-л /2, л /2],

где фи, ф^ - начальное и конечное значения угла поворота звена робота, определяемые его походкой, причем оба значения располагаются в первой четверти. На данном и последующих рисунках при построении диапазонов углов тонкая линия соответствует знаку > или <, а основная - знаку > или <.

Сформулируем цель работы. Пусть звено ползающего робота во время изменения конфигурации последнего движется по поверхности с препятствиями, каждое из которых моделируется прямоугольником ЛБПЕ. Целью исследования является разработка системы правил, позволяющих установить, возможно ли преодоление данного препятствия без корректировки движения звена.

Система управления звеном робота

На рис. 2 приведена схема четырехуровневой системы управления звеном робота. В данной схеме можно выделить следующие системы: распознавания препятствия, определения режима контактного взаимодействия с препятствием, корректировки движения звена, управления приводами робота. Система распознавания препятствия является системой верхнего уровня. Данная система позволяет определить расположение препятствия на поверхности, его форму и размеры. В рассматриваемом случае, когда препятствия моделируются прямоугольниками, в качестве информации, передаваемой системой распознавания препятствия в систему

определения режима контактного взаимодействия с препятствием, выступают координаты точки А, размеры препятствия и угол его ориентации в плоскости Оху: хА, уА, I, Ь, а . Система второго уровня

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

Рис. 2. Схема САУ движением звена ползающего робота

13

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

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

Система определения режима контактного взаимодействия с препятствием

Для описания работы системы определения режима контакта звена робота с препятствием введем следующие точки.

Пусть звену ОО\ принадлежат точки N и Е, их радиусы-векторы записываются следующим образом:

= Тр0м, Ром = (Ьм 0)Т

ГР = ТРоР , Ро^ = (ЬР 0)Т

где роы, рор - соответствующие относительные радиусы-векторы в системе координат звена; , Ьр - расстояния между

точками О и N, О и Е соответственно.

Также введем точки К, М, Q, принадлежащие сторонам препятствия ( К е АВ, М е БЕ, Q е АЕ ), которые будут необхо-

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

рAQ :

ГК = ТАрАК , рАК = (0 ьк )Т , гб = ТАраб , рам = (1 ьм у , ^ = тарaq , рaq = 0)т .

На рис. 3 приведена классификация режимов взаимодействия звена робота с препятствием. В случае наличия контакта он может происходить точкой звена (крайней точкой О\ или некоторой точкой N звена) или непосредственно звеном ОО\. Взаимодействие точки О\ может осуществляться с крайними точками (вершинами) препятствия или с точками, принад-

лежащими его сторонам, причем точка N звена может контактировать только с крайними точками препятствия, а звено ОО\ - со сторонами препятствия. Справа от каждого режима контакта введено условное обозначение возможности преодоления препятствия с корректировкой или без нее. Также возможно бесконтактное преодоление препятствия.

корректировки

Рис. 3. Классификация режимов контактного взаимодействия с препятствием

Рассмотрим каждый из режимов контакта с препятствием. Для удобства их идентификации введем следующие обозначения: п=\, 2 - для преодоления препятствия требуется корректировка движения звена, п=3, 4 - преодоление препятствия при его касании, п=5 - бесконтактное преодоление препятствия.

1V3, 0<а<к/2,

Контакт крайней точки звена с крайней точкой препятствия. Взаимодействие точек О\ звена и А препятствия (у=\) возможно тремя способами (рис. 4а-в), один из которых требует корректировки (п=1), а два других - нет (п=3, 4). Условия выполнения каждого из режимов контакта записываются следующим образом:

п = i 2 v 4,-л/2 <а< 0, 5, -л/2<а<л/2.

1 if (Г01 = ГА ) Л (Фп <а<л /2) Л (а р >Ф р X

П01-А =i3, if (Г01 = ГА ) Л (0 <а< Фк ) Л (а p <Ф p X

4, if (Г01 = Га ) Л ([Фп - л /2] < а < 0) Л (аp > [фp - л /2]). Здесь а , Ф - значения углов ориентации препятствия и звена в момент их контакта.

Рис. 4. Режимы контактного взаимодействия точек: а-в — О\ - А (а - n=1, б - n=3, в - n=4); г — Oí - В (n=3)

Взаимодействие точек О\ звена и В препятствия (у=2) всегда происходит так, что препятствие возможно преодолеть без

корректировки движения звена (рис. 4г). Соответствующее условие контакта записывается следующим образом:

Пг

= 3, Г (г01 = гв) л (фя <а<л/2) л (а „ >ф „).

Режимы взаимодействия крайних точек звена О1 и препятствия Е (у=3) приведены на рис. 5. Здесь можно выделить три режима контакта, два из которых требуют корректировки движения звена, при одном

из них а> 0 (п=1), а при другом а< 0 (п=2). Третий режим (п=4) обеспечивает преодоление этого препятствия путем его касания.

а) б) в)

Рис. 5. Режимы контактного взаимодействия точек О1 - Е: а - п=1; б - п=2; в - п=4

Условия режимов контакта описываются формулами:

1, (г01 = гЕ)л(0<а<ф^)л(ар <Фр),

2, ¡Г (гС1 = Ге ) л ([ф„ -л/2] < а < 0) л (а р > [ф р -л/2]),

п01 - е = <

4, ¡Г (г01 = Ге ) л (-л/2 <а< [фк-л/2]) л (а р < [ф р-л/2]).

Контакт крайней точки звена с точкой стороны препятствия. Взаимодействие точки О1 звена с точкой Q препятствия (у=4), принадлежащей стороне

АЕ, возможно тремя способами (рис. 6), два из которых требуют корректировки (п=1, 2), а третий (п=4) - нет.

в)

Рис. 6. Режимы контактного взаимодействия точек О1 - Q: а - п=1; б - п=2; в - п=4

Условия режимов контакта:

п

01 -в

1, (г01 = гв ) л (0 <а<фк ) л (а р <ф р ), = < 2, ¡Г (г01 = Гв) л ([фп-л/2] < а < 0) л (а р > [ф р-л/2]),

4, ¡Г (г01 = Гв) л ([фп-л/2] <а< [фк-л/2]) л (а р = [ф р-л/2]).

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

Следует отметить, что вариант преодоления препятствия без корректировки возможен только в том случае, если сторона АЕ препятствия перпендикулярна звену ОО1 в положении, когда точки О1 и Q соприкасаются.

Контакт точки О1 звена и точки К (у=5), принадлежащей стороне АВ препят-

ствия, может происходить двумя способами: при корректировке (п=1) и без нее (п=3) (рис. 7а, б). Причем корректировка не требуется только в том случае, когда сторона АВ препятствия перпендикулярна звену ОО1 при касании точек О1 и К.

в)

Рис. 7. Контакт точек: а, б - О\ - К (а - п=1, б - п=3); в - О\ - М (п=2)

Условия двух режимов контакта:

^ ^ (го1 = гк ) л (ф„ <а<к /2) л (а р >Ф р ),

I3, 1f (Г01 = ГК ) л (ф„ <а<Ф^ ) л (а р =Ф р ).

Взаимодействие точки О\ звена и точки М (у=6), расположенной на стороне ЕБ препятствия, возможно только одним

способом, требующим корректировки движения звена (п=2) (рис. 7в). Условие контакта записывается в виде

п,

01-М

= 2, # ((г01 = Гм ) л (-к/2 <а< [фк -к/2]) л (а р < [ф р-к/2]).

Контакт точки звена N с крайней точкой препятствия. Перейдем к рассмотрению режима взаимодействия некоторой точки звена N с крайней точкой пре-

пятствия А (у=7). В этом случае преодоление препятствия возможно только после корректировки движения звена (п=\) (рис. 8а).

в)

Рис. 8. Режимы контактного взаимодействия точек: а - N - А (п=]_); б, в - N - Е (б - п=1, в - п=2) Условие реализации этого режима контакта записывается следующим образом:

п

м - А

= 1 ^ (ГМ = ГА ) Л (Фп <а<К/2) Л (а р >ф р ).

а > 0 (п=1), в другом а < 0 (п=2). Условия режимов контакта точек N и Е записываются следующим образом:

Режимы контакта точки N звена с точкой Е препятствия (у=8) представлены на рис. 9б, в. Оба режима требуют корректировки движения звена, в одном случае

| 1 ^ (гм = ГЕ ) Л (0 < а < ф^) л (ар < фр X

2,1Г (Гм = Ге) л ([фп - к /2] < а < 0) л (а, > [ф, - к / 2]).

ПМ-Е

Контакт звена робота со стороной препятствия. Перейдем к рассмотрению взаимодействия звена со сторонами препятствия. Вначале рассмотрим контакт со стороной АЕ (у=9). Данный контакт наблюдается, если две точки, принадлежащие звену, взаимодействуют с двумя точками, принадлежащими стороне АЕ препятствия. Причем можно выделить три варианта взаимодействия: 1) некоторые

точки звена - крайние точки стороны АЕ; 2) некоторая точка звена и его крайняя точка - крайние точки стороны АЕ; 3) некоторая точка звена и его крайняя точка -некоторая точка стороны АЕ и точка А . Первый режим взаимодействия показан на рис. 9а. Углы ориентации препятствия и звена робота в этом случае равны между собой.

а) б) в)

Рис. 9. Взаимодействие звена ОО1 со стороной препятствия: а — АЕ (п=1); б — ЕБ (п=2); в - отсутствие взаимодействия робота и препятствия (п=5)

При таком контакте звена робота и препятствия всегда требуется корректировка движения (п=1):

п001-АЕ = 1 Г ([(г^ = ГА ) л (ГР = ГЕ)] V [(Г^ = ГА ) л (Г01 = ГЕ )] V [(Г^ = ГА ) л (Г01 = Гв )]) л

(фп <а<ф^ ) л (а р =ф р ).

Другой режим контакта звена со стороной препятствия показан на рис. 9б. В этом случае в качестве контактной стороны препятствия выступает ЕБ (у=10), режимы взаимодействия аналогичны рас-

смотренным для стороны препятствия АЕ. Такой режим контакта возможен только при условии, что сторона АЕ препятствия перпендикулярна звену. Условия контакта имеют вид

П001-ЕВ = 2, Г ([(Г^ = ГЕ) л (ГЕ = ГВ )] V [(Г^ = ГЕ ) л (Г01 = ГП )] V [(Г^ = ГЕ ) л (Г01 = ГМ )]) л

([фп -л/2] <а< [фк -л/2]) л (а р = [ф р-л/2]).

Взаимодействие звена робота с препятствием отсутствует. Последний из возможных вариантов преодоления препятствия - бесконтактный - показан на

п = 5 ¡Г (гл > г01) л (гв > г01 ) л (гя > г01) л (-л /2 < а < л /2).

Диапазон угла ориентации препятствия при этом не зависит от значений

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

начального и конечного углов поворота звена робота.

Диаграммы режимов контактного взаимодействия

Обобщим сформулированные выше условия рассмотренных режимов контакта звена робота с препятствием и запишем

условия выполнения того или иного режима преодоления препятствия.

Режимы контакта, требующие корректировки движения звена робота:

п = И? [(а е (фп ; л/2]) л (а р >ф р ) л (Го1 - А V Г01-К V Г^-А )]V

[(а е[0; ф^)) л (а р < фр) л (го1-е V г01 -в V ГЫ-Е ) I V

[(а е [фп ; ф^ ]) л (а р = ф р ) л [(г^ - А л ГЕ-Е ) V (г^ - А л Г01 -Е ) V (г^ - А л Г01 -в )]]

V г,

V

п = 2 [(а е (ф„ - л / 2; 0)) л (ар > [фр - л / 2]) л (г01_я V ^ [(ае(-л/2; фк -л/2))л(ар > [фр -л/2])лг01-М]V

[(ае[Фп -л/2; фк -л/2]) л (а р = [ф р -л/2]) л [К-Е л ГЕ-В ) V

N - Е

л го1-о ) V (г/*г 17 л Г

N-Е '

01-М

движения звена робота (при касании точек звена и препятствия):

Режимы контакта, позволяющие преодолеть препятствие без корректировки

п = 3 ¡Г [(ае[о; фк])л(ар <фр)лго1-а]V

[(ае[фп; л /2]) л (ар >фр) л го1-в ] V [(ае[фп; фк]) л (ар =Фр) л го1-к]>

п = 4 ¡Г [(а е [фп - л / 2; 0)) л (ар > [фр - л / 2]) л ^ ] V

[(ае(-я/2; фк-л/2])л(ар <[фр-л/2])лго1-Е

] V

[(ае[фп-л/2; фк-л/2))л(ар = [фр-л/2])лг01-е].

Бесконтактный способ преодоления препятствия, не требующий корректировки движе-

ния звена:

п = 5 ¡Г [(ае (-л/2; л/2]) л г

где гт_А и аналогичные обозначения соот-

ветствуют записи г01 = г^, а г

А>01

и анало-

гичные означают гА > г01.

На рис. 10 построены поясняющие записанные выше режимы преодоления препятствий (п=1-4) диаграммы диапазо-

А>01 л гв>01 л гЕ>01],

нов угла а ориентации препятствия, а на рис. 1 1 приведены диаграммы, иллюстрирующие соотношение между углами ар и фр. Цифры 1-10 на диаграммах соответствуют режиму контакта у=1-10.

л/2

а) б)

Рис. 10. Диаграммы диапазонов угла а при у=1-10: а - п=1, 4; б - п=2, 3

> 1 2 3 4 5 6 7 8 1 9 1 10 1

1 1 --1-- 1 1 I 1 1 1 1 1 1 1

Г i Г 1 1 1 1

_ _ 1 i 1 i 1 1 I i

1 1

T T 1 1

Рис. П. Диаграммы диапазонов угла

Заключение

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

б)

ар при у=Ы0: а - п=\, 4; б - п=2, 3

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

Работа выполнена в рамках гранта Президента МК-200.2019.1.

СПИСОК ЛИТЕРАТУРЫ

1. Liljeback, P. A review on modelling, implementation and control of snake robots / P. Liljeback, K.Y. Pettersen, Q. Stavdahl, J.T. Gravdahl // Robotics and Autonomous systems. - 2012. - Vol. 60. - № 1. - P. 29-40.

2. Hu, D. The mechanics of slithering locomotion / D. Hu, J. Nirody, T. Scott, M. Shelley // Proc. National Academy of Sciences, USA. - 2009. - Vol. 106. - P. 10081-10085.

3. Ishikawa, M. Iterative feedback control of snakelike robot based on principal fiber bundle modeling / M. Ishikawa // Int. J. Advanced Mechatronic Systems. - 2009. - Vol. 1. - № 3. - P. 175-182.

4. Matsuno, F. Trajectory tracking control of snake robots based on dynamic model / F. Matsuno, H. Sato // Proc. IEEE Int. Conf. on Robotics and Automation. - 2005. - P. 3029-3034.

5. Saito, M. Serpentine locomotion with robotic snakes / M. Saito, M. Fukaya, T. Iwasaki // IEEE Contr. Syst. Mag. - 2002. - Vol. 22. - № 1. - P. 6481.

6. Li, J. Passivity control of underactuated snake-like robots / J. Li, J. Shan // Proc. 7th World Congress

on Intelligent Control and Automation. - 2008. - P. 485-490.

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

7. Liljebäck, P. Hybrid modelling and control of obstacle-aided snake robot locomotion / P. Liljebäck, K.Y. Pettersen, Q. Stavdahl, J.T. Gravdahl // IEEE Trans. Robotics. - 2010. - Vol. 26. - № 5. - P. 781799.

8. Transeth, A.A. Snake robot obstacle aided locomotion: Modeling, simulations, and experiments / A.A. Transeth, R.I. Leine, C. Glocker, K.Y. Pettersen, P. Liljebäck // IEEE Trans. Rob. - 2008. - Vol. 24. - № 1. - P. 88-104.

9. Vorochaeva, L.Yu. Simulation of Motion of a Three-Link Robot with Controlled Friction Forces on a Horizontal Rough Surface / L.Yu. Vorochaeva, G.S. Naumov, S.F. Yatsun // J. of Computer and Systems Sciences International. - 2015. - Vol. 54. -№ 1. - P. 151-164.

10. Vorochaeva, L.Yu. Movement Simulation of a Five-Link Crawling Robot with Controlled Friction Forces / L.Yu. Vorochaeva, G.Ya. Panovko, S.I. Savin, A.S. Yatsun // J. of Machinery Manufacture and Reliability. - 2017. - Vol. 46. - № 6. - P. 527535.

1. Liljeback, P. A review on modelling, implementation and control of snake robots / P. Liljeback, K.Y. Pettersen, Q. Stavdahl, J.T. Gravdahl // Robotics and Autonomous systems. - 2012. - Vol. 60. - № 1. - P. 29-40.

2. Hu, D. The mechanics of slithering locomotion / D. Hu, J. Nirody, T. Scott, M. Shelley // Proc. National Academy of Sciences, USA. - 2009. - Vol. 106. - P. 10081-10085.

3. Ishikawa, M. Iterative feedback control of snakelike robot based on principal fiber bundle modeling / M. Ishikawa // Int. J. Advanced Mechatronic Systems. - 2009. - Vol. 1. - № 3. - P. 175-182.

4. Matsuno, F. Trajectory tracking control of snake robots based on dynamic model / F. Matsuno, H. Sato // Proc. IEEE Int. Conf. on Robotics and Automation. - 2005. - P. 3029-3034.

5. Saito, M. Serpentine locomotion with robotic snakes / M. Saito, M. Fukaya, T. Iwasaki // IEEE Contr. Syst. Mag. - 2002. - Vol. 22. - № 1. - P. 6481.

6. Li, J. Passivity control of underactuated snake-like robots / J. Li, J. Shan // Proc. 7th World Congress

on Intelligent Control and Automation. - 2008. - P. 485-490.

7. Liljebäck, P. Hybrid modelling and control of obstacle-aided snake robot locomotion / P. Liljebäck, K.Y. Pettersen, Q. Stavdahl, J.T. Gravdahl // IEEE Trans. Robotics. - 2010. - Vol. 26. - № 5. - P. 781799.

8. Transeth, A.A. Snake robot obstacle aided locomotion: Modeling, simulations, and experiments / A.A. Transeth, R.I. Leine, C. Glocker, K.Y. Pettersen, P. Liljebäck // IEEE Trans. Rob. - 2008. - Vol. 24. - № 1. - P. 88-104.

9. Vorochaeva, L.Yu. Simulation of Motion of a Three-Link Robot with Controlled Friction Forces on a Horizontal Rough Surface / L.Yu. Vorochaeva, G.S. Naumov, S.F. Yatsun // J. of Computer and Systems Sciences International. - 2015. - Vol. 54. -№ 1. - P. 151-164.

10. Vorochaeva, L.Yu. Movement Simulation of a Five-Link Crawling Robot with Controlled Friction Forces / L.Yu. Vorochaeva, G.Ya. Panovko, S.I. Savin, A.S. Yatsun // J. of Machinery Manufacture and Reliability. - 2017. - Vol. 46. - № 6. - P. 527535.

Ссылка для цитирования:

Ворочаева, Л.Ю. Разработка системы определения режима контактного взаимодействия звена ползающего робота с препятствием /Л.Ю. Ворочаева, С.И. Савин, А.С. Яцун //Вестник Брянского государственного технического университета. - 2019. - № 8. - С. 11 - 21.

Статья поступила в редакцию 11.06.19 Рецензент: д.т.н., профессор Брянского государственного

технического университета, главный редактор журнала «Вестник БГТУ»

Киричек А.В.

Статья принята к публикации 26. 06. 19.

Сведения об авторах:

Ворочаева Людмила Юрьевна, к.т.н., доцент Юго-Западного государственного университета, email: mila180888@vandex.ru.

Савин Сергей Игоревич, к.т.н., ст.научный сотрудник Университета Иннополис, e-mail: s.savin@innopolis.ru.

Яцун Андрей Сергеевич, к.т.н., зав. лабораторией мехатроники и робототехники Юго-Западного государственного университета, e-mail: avatsun@vandex. ru.

Vorochaeva Lyudmila Yurievna, Can. Sc. Tech., Assistant Prof., South-Western State University, e-mail: mila180888@yandex.ru. Savin Sergey Igorevich, Can. Sc. Tech., Senior Research Assistant, University of Innopolis, e-mail: s.savin@innopolis.ru.

Yatsun Andrey Sergeevich, Can. Sc. Tech., Head of the Lab. "Mechatronics and Robotics", South-Western State University, e-mail: ayatsun@yandex.ru.

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