Научная статья на тему 'Применение блока инерциальных датчиков для оценивания положения и управления движением экзоскелета нижних конечностей'

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

CC BY
134
25
i Надоели баннеры? Вы всегда можете отключить рекламу.
Ключевые слова
экзоскелет / математическая модель / инерциальные датчики / управление / оценка состояния / exoskeleton / mathematical model / inertial sensors / control / state estimation

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

Введение. Исследуется задача управления движением экзоскелета нижних конечностей. Для ее решения предлагается задействовать программное управление и управление в виде обратной связи. Формирование управления в виде обратной связи требует оценки состояния экзоскелета (углы поворота, угловые скорости и ускорения звеньев). Рассматривается возможность применения блока инерциальных датчиков для оценки угловых скоростей и ускорений звеньев экзоскелета. Цель работы — определить законы формирования управления движением экзоскелета, которые обеспечат устойчивость программного движения и будут использовать измерения энкодеров, микромеханических гироскопов и акселерометров. Материалы и методы. Ранее выполненное математическое моделирование динамики экзоскелета задействовали при формировании программного управления. Предложили оснастить экзоскелет блоками инерциальных датчиков. Это решение позволяет оценивать вектор состояния экзоскелета и использовать данные оценки в цепи обратной связи. Описали математическую модель измерений указанных датчиков. Предложенный вариант пригоден для систем управления трехзвенными экзоскелетами нижних конечностей и может быть расширен для многозвенных. Результаты исследования. Предложены новые законы управления движением экзоскелета, основанные на математической модели динамики системы и использующие измерительную информацию с энкодеров и инерциальных датчиков. В математическом пакете Wolfram Mathematica выполнено численное моделирование движения экзоскелета. Его итоги подтвердили работоспособность предложенного управления и возможность использования блока инерциальных датчиков для оценки состояния экзоскелета. Приводятся результаты численного моделирования для следующих программных движений: подъем экзоскелета из положения сидя в вертикальное и стабилизация вертикального положения равновесия. Обсуждение и заключения. Предлагаемое управление применимо в экзоскелетах для медицинских приложений (например, в задаче вертикализации пациентов с нарушениями функций опорно-двигательного аппарата). Показана возможность использования измерительной информации, полученной от блоков инерциальных датчиков, в задаче оценки состояния звеньев экзоскелета. Применение инерциальных датчиков позволит определять угловое ускорение звеньев экзоскелета, избегая численного дифференцирования измерительной информации, полученной от энкодеров. Оценки углового ускорения позволяют вводить в систему управления обратную связь по угловым ускорениям, что открывает возможность улучшить переходные процессы при управлении движением экзоскелета.

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

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

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

Application of an Inertial Sensor Unit for Position Estimation and Motion Control of the Lower-Extremity Powered Exoskeleton

Introduction. The problem of controlling the lower-extremity powered exoskeleton motion was investigated. To solve it, it was proposed to use a program control and feedback control. The formation of control in the form of feedback required an assessment of the state of the exoskeleton (rotation angles, angular velocities, and accelerations of the links). The possibility of using an inertial measuring unit to estimate angular velocities and accelerations of exoskeleton links was considered. The work objective was to develop laws for the formation of the exoskeleton motion control, which could provide the stability of the program motion and use the measurements of encoders, micromechanical gyroscopes and accelerometers. Materials and Methods. Previously performed mathematical modeling of the exoskeleton dynamics was used to form a program control. It was proposed to equip the exoskeleton with inertial sensor units. This solution made it possible to evaluate the state vector of the exoskeleton and to use these estimates in a feedback loop. A mathematical model of measurements of these sensors was described. The proposed version is suitable for control systems of three-link exoskeletons of the lower extremities and can be expanded to the case of multi-link exoskeleton designs. Results. New laws of exoskeleton motion control based on a mathematical model of the system dynamics and using measurement information from encoders and inertial information sensors were proposed. Numerical simulation of exoskeleton motion was performed in the Wolfram Mathematica mathematical package. Its results confirmed the operability of the proposed control and the possibility of using an inertial sensor unit to assess the exoskeleton state. The numerical simulation results for the following program movements were presented: lifting the exoskeleton from a sitting position to a vertical position, and stabilization of the vertical equilibrium position. Discussion and Conclusions. The proposed control can be applied in exoskeletons for medical purposes, e.g., in the task of verticalization of patients with dysfunctions of the musculoskeletal system. The possibility of using measurement information obtained from inertial measurements units in the problem of estimating the state of exoskeleton links was demonstrated. The use of inertial sensors will make it possible to determine the angular acceleration of the exoskeleton links, avoiding numerical differentiation of the measurement information received from the encoders. The obtained estimates of angular acceleration allow us to introduce feedback on angular accelerations into the control system, which opens up the possibility of improving transients in controlling the exoskeleton motion.

Текст научной работы на тему «Применение блока инерциальных датчиков для оценивания положения и управления движением экзоскелета нижних конечностей»

и

МЕХАНИКА MECHANICS

Hi Check for updates

УДК 531.132.1 Научная статья

https://doi.org/10.23947/2687-1653-2022-22-3-204-213 HlfiKJH

Применение блока инерциальных датчиков для оценивания положения и управления движением экзоскелета нижних конечностей

Г. Р. Сайпулаев ED, М. Р. Сайпулаев , И. В. Меркурьев , Б. И. Адамов , Р. Б. Гарсия

Национальный исследовательский университет «МЭИ», Российская Федерация, г. Москва, ул. Красноказарменная, 14 И saypulaevgr@mail.ru

Аннотация

Введение. Исследуется задача управления движением экзоскелета нижних конечностей. Для ее решения предлагается задействовать программное управление и управление в виде обратной связи. Формирование управления в виде обратной связи требует оценки состояния экзоскелета (углы поворота, угловые скорости и ускорения звеньев). Рассматривается возможность применения блока инерциальных датчиков для оценки угловых скоростей и ускорений звеньев экзоскелета. Цель работы — определить законы формирования управления движением экзоскелета, которые обеспечат устойчивость программного движения и будут использовать измерения энкодеров, микромеханических гироскопов и акселерометров.

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

Результаты исследования. Предложены новые законы управления движением экзоскелета, основанные на математической модели динамики системы и использующие измерительную информацию с энкодеров и инерциальных датчиков. В математическом пакете Wolfram Mathematica выполнено численное моделирование движения экзоскелета. Его итоги подтвердили работоспособность предложенного управления и возможность использования блока инерциальных датчиков для оценки состояния экзоскелета. Приводятся результаты численного моделирования для следующих программных движений: подъем экзоскелета из положения сидя в вертикальное и стабилизация вертикального положения равновесия.

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

и

g измерительной информации, полученной от энкодеров. Оценки углового ускорения позволяют вводить в тз

Л

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

^ Ключевые слова: экзоскелет, математическая модель, инерциальные датчики, управление, оценка состояния.

^ Финансирование. Исследование проводилось в рамках проекта «Разработка макетного образца активного £ экзоскелета на базе электрогидропневмопривода, увеличивающего физические способности человека и качество процессов управления движением» при поддержке гранта НИУ «МЭИ» на реализацию программ научных исследований «Энергетика», «Электроника, радиотехника и ГГ» и «Технологии индустрии 4.0 для промышленности и робототехники» в 2020-2022 гг.

204

© Сайпулаев Г. Р., Сайпулаев М. Р., Меркурьев И. В., Адамов Б. И., Гарсиа Р. Б., 2022

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

Для цитирования. Применение блока инерциальных датчиков для оценивания положения и управления движением экзоскелета нижних конечностей / Г. Р. Сайпулаев, М. Р. Сайпулаев, И. В. Меркурьев [и др.] // Advanced Engineering Research. — 2022. — Т. 22, № 3. — С. 204-213. https://doi.org/10.23947/2687-1653-2022-22-3-204-213

Original article

Application of an Inertial Sensor Unit for Position Estimation and Motion Control of the Lower-Extremity Powered Exoskeleton

Gasan R. Saypulaev ED, Musa R. Saypulaev , Igor V. Merkuryev , Boris I. Adamov , Roilan B. Garcia

National Research University (MPEI), 14, Krasnokazarmennaya St., Moscow, Russian Federation И saypulaevgr@mail.ru

Abstract

Introduction. The problem of controlling the lower-extremity powered exoskeleton motion was investigated. To solve it, it was proposed to use a program control and feedback control. The formation of control in the form of feedback required an assessment of the state of the exoskeleton (rotation angles, angular velocities, and accelerations of the links). The possibility of using an inertial measuring unit to estimate angular velocities and accelerations of exoskeleton links was considered. The work objective was to develop laws for the formation of the exoskeleton motion control, which could provide the stability of the program motion and use the measurements of encoders, micromechanical gyroscopes and accelerometers.

Materials and Methods. Previously performed mathematical modeling of the exoskeleton dynamics was used to form a program control. It was proposed to equip the exoskeleton with inertial sensor units. This solution made it possible to evaluate the state vector of the exoskeleton and to use these estimates in a feedback loop. A mathematical model of measurements of these sensors was described. The proposed version is suitable for control systems of three-link exoskeletons of the lower extremities and can be expanded to the case of multi-link exoskeleton designs. Results. New laws of exoskeleton motion control based on a mathematical model of the system dynamics and using measurement information from encoders and inertial information sensors were proposed. Numerical simulation of exoskeleton motion was performed in the Wolfram Mathematica mathematical package. Its results confirmed the operability of the proposed control and the possibility of using an inertial sensor unit to assess the exoskeleton state. The numerical simulation results for the following program movements were presented: lifting the exoskeleton from a sitting position to a vertical position, and stabilization of the vertical equilibrium position.

Discussion and Conclusions. The proposed control can be applied in exoskeletons for medical purposes, e.g., in the task of verticalization of patients with dysfunctions of the musculoskeletal system. The possibility of using measurement information obtained from inertial measurements units in the problem of estimating the state of exoskeleton links was demonstrated. The use of inertial sensors will make it possible to determine the angular acceleration of the exoskeleton links, avoiding numerical differentiation of the measurement information received from the encoders. The obtained estimates of angular acceleration allow us to introduce feedback on angular accelerations into the control system, which opens up the possibility of improving transients in controlling the exoskeleton motion.

Keywords: exoskeleton, mathematical model, inertial sensors, control, state estimation.

ce

Funding information. The research was carried out within the framework of the project "Development of a prototype t^ of an active exoskeleton based on an electrohydropneumatic actuator that increases human physical abilities and the ce quality of motion control processes". It was supported by the grant from the National Research University (MPEI) for the implementation of research programs "Power Engineering", "Electronics, Radio Engineering, and IT", and "Industry 4.0 Technologies for Manufacturing and Robotics" in 2020-2022.

Acknowledgements. The authors express their gratitude to reviewers, whose critical assessment of the submitted materials and suggestions for their improvement contributed significantly to the quality of this article.

For citation. G. R. Saypulaev, M. R. Saypulaev, I. V. Merkuryev, B. I. Adamov, R. В. Garcia. Application of an Inertial Sensor Unit for Position Estimation and Motion Control of the Lower-Extremity Powered Exoskeleton. Advanced Engineering Research, 2022, vol. 22, no. 3, pp. 204-213. https://doi.org/10.23947/2687-1653-2022-22-3-204-213

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

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

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

При разработке таких экзоскелетов возникает необходимость решения взаимосвязанных научно -технических задач. В их числе:

- формирование скелетной схемы;

- математическое моделирование движения экзоскелета [4-6];

- оптимизация движения звеньев на основе математической модели кинематики и динамики1;

- рациональное построение двигательной системы [7, 8];

- разработка алгоритмов управления [9-11] и оценивания [13, 14].

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

Для получения информации о положении звеньев экзоскелетов их оснащают энкодером или гироскопом [9-14]. Другие возможные варианты: акселерометр, магнитометр, потенциометр, датчики момента, силы, биосигналов и др.

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

Цель работы — улучшение управления экзоскелетом за счет использования двух инерциальных блоков,

закрепленных на каждом звене экзоскелета. Такой подход позволяет оценивать углы поворота, угловые

скорости и ускорения экзоскелета. С помощью предлагаемого варианта расположения гироскопов и

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

^ управления и применения теории оптимального оценивания линейных систем [15]. Это, в свою очередь, станет

и базой для совершенствования управления движением экзоскелета. Критерий улучшения качества й

do управления — уменьшение отклонений угловых скоростей звеньев от программного движения.

Материалы и методы. Рассмотрим кинематическую схему экзоскелета с жесткой конструкцией силового каркаса при симметричном движении ног в сагиттальной плоскости (рис. 1).

<U

£ -Й

1 Оптимизация времени вертикализации экзоскелета по критерию энергоэффективности / С. Ф. Яцун [и др.] // Вибрационные технологии, 206 мехатроника и управляемые машины. Курск : Изд-во Юго-Зап. гос. ун-та, 2016. Ч. 2. С. 151-160.

— матрица инерционных сил;

матрица скоростных сил;

Рис. 1. Кинематическая схема экзоскелета нижних конечностей в сагиттальной плоскости

С2, С3, С4 — центры масс голеней, бедер и корпуса соответственно; Аь А2, А3 — шарниры, соединяющие звенья экзоскелета; ф2, ф3, ф4 — углы поворота звеньев экзоскелета; М2, М3, М4 — управляющие моменты, создаваемые приводами, расположенными в шарнирах Аь А2, А3 соответственно. Для описания движения вводится система координат xyz. Ось x направлена вдоль опорной поверхности, y — вдоль местной вертикали к опорной поверхности. Ось z дополняет координатные оси до правой декартовой системы координат.

В качестве основы для построения системы управления движением экзоскелета используем динамическую модель из [6].

A(q)q + F(q)q2+Dq + P(q) = M. (1)

Здесь:

J22 J23 cos (ф2 - Ф3 ) J24 cos (ф2 - Ф4

A(q)= J23cos (ф2 - Ф3 ) J33 J34 C0s (Ф3 - Ф4 )

v J24cos (Ф2 - Ф4 ) J34 C0S (Ф3 - Ф4 ) J44 у

0 J23 sin (Ф2 - Ф3) J24 sin (Ф2 - Ф4

F (q)= J23 sin (Ф2 - Ф3 ) 0 J34 Sin (Ф3 - Ф4 )

v-J24sin (Ф2 - Ф4) J34 sin (Ф3 - Ф4) 0 у

D = diag(ц2,ц3,ц4) — диагональная матрица диссипативных сил, характеризующих линейное трение в шарнирах; P (q) = (MG2cos Ф2 MG3 cosф3 MG4 cosф4 )T — вектор-столбец моментов, возникающих от действия сил тяжести; M = (M2 - M3 M3 - M M )T — вектор-столбец управляющих моментов, создаваемых приводами, которые расположены в шарнирах звеньев экзоскелета; q = (ф2 ф3 ф4 )T — вектор-столбец обобщенных координат, состоящий из углов поворота звеньев экзоскелета; Jjk (j,k = 2,3,4) — моменты инерции звеньев экзоскелета; цк (k = 2,3,4) — коэффициенты линейного трения в шарнирах звеньев экзоскелета; MGk (k = 2,3,4) — максимальные величины моментов гравитационных сил, воспринимаемые

выходными звеньями приводов.

Пусть заданы законы изменения углов и их производные при программном движении:

ф1р = фГа). ФГ = ФГа). <pf = (pf(t). (i=2.3,4). (2)

Для управления движением экзоскелета предлагается формировать управляющие воздействия в виде суммы управляющих моментов:

- при программном управлении Mf = М (ф|', ф^', ф1') (i = 2,3,4) ;

й и к

К а X <и

Й О тз

л 'й

и

О, С -Й

- ПИД регулятора Мрш = М1 (ф1р - ф1, ф1р - ф1, ф1р - ф1), (1 = 2,3,4) .

М2 = Мр + Мр11

М3 = Мр + Мр11

М4 = мр + Мр11

(3)

Для программного управления значения управляющих воздействий Мр можно рассчитать по формулам [7]:

Мр = МС4 сое фр + ц4фр + 14фр + ]2

фр сое (фр - фр) - (фрвт (фр - фр)

+1,

фр сое (фр - фр) - (фр¡ип (фр - фр)

Мр = Мсз сое фр + ц3фр + 13фр + ]2

фр сое (фр - Фр) - (фрвт (фр - Фр)

+1,

фр сое (фр - фр) + (фр)" вт (фр - фр)

(4)

+мр

Мр = М02 сое фр + ц2 фр + ]2 фр + ]2

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

фр сое (фр - Фр) + (фр)" вт (фр - Фр)

+1,

фр сое (фр - фр) + (фр)" вт (фр - фр)

+ Мр.

Величины Мрш вычисляются по принципу обратной связи (в форме ПИД регулятора):

мрш = кС4—(фР - ф4)+кР4 (фр - ф4) +к14 |(фР (I,) - ф4 а, >) л,,

си 0

1 I

мрш=кю^(фр-ф3)+кРЗ(ф3р-ф3)+к13|(ф3ра1)-ф3а1))с111+мрш.

(5)

или

Мр11 =

мр

-(фР -ф2)+кр2 (фр -ф2)+к12 {(фр^-ф^))^+мр

= Км (фр - ф4) + КР4 (фр - ф4) +К14 (фр - Ф4),

мрю = кю (ФР - ф3)+крз (фр - ф3) +к13 (Фр - Фз )+м мрю = км (фр - ф2)+кР2 (фр - ф2) +к12 (Фр - ф2)+мрю.

рю

4 '

(6)

Здесь коэффициенты ПИД регулятора КР, Ки, Кш (/' = 2, 3, 4) могут быть:

- постоянными (их находят из условий устойчивости);

- функциями времени (находят из решения задач оптимального управления) [9, 13].

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

- энкодеры (для измерения текущих углов поворота ф звеньев экзоскелета);

- блоки инерциальных датчиков из микромеханических гироскопов (для измерения угловых скоростей ф;) и акселерометров (для оценки угловых скоростей ф; и ускорений ф;).

Модель измерений углов поворота с помощью энкодеров можно представить в виде:

ФЕ2 = Ф2 > ФЕ3 + Фе2 = Фз > ФЕ4 + ФЕЗ + ФЕ2 = Ф4 > (7)

где фЕ2,фЕЗ,фЕ4 — показания энкодеров, расположенных в шарнирах А1, а2, а3 (рис. 1).

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

Ос2=ф2, П03=Ф3, Цз4=Ф4, (8)

где 0,а2, 0.03, 0.д4 — показания гироскопов, закрепленных на звеньях экзоскелета.

Для оценки угловых скоростей и ускорений с помощью акселерометров можно использовать по два двухосевых акселерометра, которые расположены на противоположных концах каждого из звеньев. Они измеряют в проекциях на оси х,у, (/ = 1, 2, 3) кажущиеся ускорения, связанные с соответствующими звеньями.

0

42а3 "42А3 =((4'А3 "42А3)Х1 (42А3 "42А3 )У1 ) = (1гФз Ч Фз) - (9)

Здесь ^"д ,Гд2а — векторы показаний двухосевых акселерометров, закрепленных на звене А А и

расположенных в точках А и А соответственно; , ^^ — векторы показаний двухосевых акселерометров, закрепленных на звене А А и расположенных в точках А2 и А соответственно; 1а)С'1а3с — векторы показаний двухосевых акселерометров, закрепленных на звене А3С и расположенных в точках А и С соответственно; 1 = |А[А2|,12 = |А2А3|,13 = АС — расстояния между парами акселерометров, закрепленных на звеньях А А, А А и АС соответственно.

Объединим уравнения (7)—(9) и запишем формулы для оценки углов поворота, угловых скоростей и ускорений:

ф2=фЕ2, ф3=фи+фЕ2, ф4 =фЕ4+фЕЗ+фЕ2, ф2=002, Фз=Цзз, ф4=004,

(^А, -^А,) (1А2А3 ~1А2А3 ) (^А3С_^А3с) (10)

ф2=--;-Ч Фз =--;--- Ф4=--;--

1[ 12 13

Для коррекции оценок модулей угловых скоростей можно использовать уравнения:

"^А2)Х1 =1102, (^А3 =12Фз- (^С "^с)Хз =М>4. (П)

Таким образом, для оценки углов поворота, угловых скоростей и угловых ускорений звеньев экзоскелета можно обработать измерения фильтром скользящего среднего, алгоритмом фильтра Калмана и др. [10, 13, 15].

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

( 1гС гА, \ \

м4 = мр + Кш

\ А3С 1А3с)

Ф4+"

У

АА

М3 = Мр + Кю

\ а2А3 А

..р \ "V".3 "А2А3 /у

Фз+"

12

V У

( /м, гА \ А

КР4 (фр - 004) +К14 (фр - фЕ4 - фЕЗ - фЕ2), + Крз (ф> -С>03) +К13 (Фзр - ФЕЗ - ФЕ2) + М™. (12)

М2 = мр + КС2

^А1А2 ЧА2/1 Ф2+-;--

-кР2(фР-о02)+к12 (фр-фЕ2)+м3рю.

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

Смоделируем движения экзоскелета для проверки работоспособности предложенного закона управления. В качестве программного движения рассмотрим:

- смену положения из сидячего в стоячее [7];

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

модели экзоскелета из [6, 7]. Рассмотрим частный случай, выбрав одинаковые коэффициенты ПИД регулятора

для каждого привода: Кк = 1000Н• м• с, К = 1°00Н• м, Ки = 0Н• м/с^ = 2,3,4). К

К

На рис. 2 приведены зависимости от времени для углов поворота и угловых скоростей звеньев экзоскелета. ^ Их получили при управляющих моментах, соответствующих подъему из положения сидя. Как видно из рис. 2 а, ^ по окончании движения углы поворота каждого звена равны ф2 = ф3 = ф4 = 90° , что соответствует стоянию.

Фу

150

100

ч

ф

) Ф2 ф4

2 4 3 10 12 14

а)

t. s

Рис. 2. Результаты моделирования подъема из положение сидя без начальных отклонений от программного движения в углах поворота звеньев экзоскелета: а — углы поворота звеньев; б — угловые скорости звеньев

й О тз

л 'й

и

о, £ -й

Теперь рассмотрим случай с отклонениями около 20° в углах поворота звеньев по сравнению с начальным положением, заданным в программном движении. Результаты моделирования подъема из положения сидя приведены на рис. 3. Как и на рис. 2, по окончании времени движения значения углов поворота равны Ф = Фз = Ф = 90° . Следовательно, использование комбинации программного управления и управления в виде ПИД регулятора точно приводит экзоскелет к требуемому положению.

Ф,

30 20 10

Ys

-10 -20 -30

Т. s

V 4 Л

V

\\

ГЧ ( 5 ! V Ж 1 2 1

ф2

Л

Фз

t. s

а) б)

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

Рис. 3. Результаты моделирования подъема из положения сидя при начальных отклонениях от программного движения в углах поворота звеньев экзоскелета: а — углы поворота звеньев; б — угловые скорости звеньев

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

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

Проверим работоспособность предложенного управления в задаче стабилизации вертикального положения экзоскелета. Значения для программного движения: Фа (0 = Ф3а (0 = Фа (О = 90° . Рассмотрим случай, когда в углах поворота звеньев есть отклонения около 20° от вертикального положения (рис. 4).

120|-

100

80 60 40 20

- у " ф2 у Фз 1

-—

к - ф4

2 4 6 8 10 12 14

Г. в

а) б)

Рис. 4. Результаты моделирования стабилизации вертикального положения при начальных отклонениях от программного движения в углах поворота звеньев экзоскелета: а — углы поворота звеньев; б — угловые скорости звеньев

Из рис. 4 видно, что предложенное управление обеспечивает стабилизацию вертикального положения звеньев экзоскелета.

Для сравнения приведем результаты моделирования стабилизации вертикального положения при использовании следующих значений коэффициентов ПИД регулятора: Кк = 1000 Н • м • с, К = 1000 Н • м,

Ки = 100 Н• м/с ^ = 2,3,4) (рис. 5).

Ф,

120

80 60 40 20

V Л <Рз N

Ф2 ^---

¥ ; Ф4

2 4 6 8 10 12 14

I

20 15

10

5

-5 -10

- 15

I. в

\ф4

V

х

у ^ {— ( 5 1 0 1 2 4

\ УФз :

а) б)

Рис. 5. Результаты моделирования стабилизации вертикального положения при начальных отклонениях от программного движения в углах поворота звеньев экзоскелета: а — углы поворота звеньев; б — угловые скорости звеньев

Из рис. 5 видно, что при использовании дифференциального звена (Ки Ф 0) регулятора можно снизить выбросы в зависимостях угловых скоростей звеньев экзоскелета по сравнению со случаем Ки = 0 (рис. 4 б).

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

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

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

й и к

К а

X <и

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

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

1. Exoskeletons for Industrial Application and Their Potential Effects on Physical Work Load / M. P. De Looze, T. Bosch, F. Krause [et al.] // Ergonomics. — 2015. — Vol. 59. — P. 671-681. https://doi.org/10.1080/ 00140139.2015.1081988

2. Геворкян, А. А. Роботизированная механотерапия: возможность применения экзоскелета для нижних конечностей у пациентов с нарушением функции ходьбы при рассеянном склерозе / А. А. Геворкян, С. В. Котов, В. Ю. Лиждвой // Альманах клинической медицины. — 2020. — Т. 48, № 1. — С. 7-12.

3. Экзоскелет — состояние проблемы и перспективы внедрения в систему абилитации и реабилитации инвалидов (аналитический обзор) / А. А. Воробьев, О. А. Засыпкина, П. С. Кривоножкина [и др.] // Вестник Волгоградского государственного медицинского университета. — 2015. — Вып. 2 (54). — С. 9-17.

4. Трехзвенная математическая модель для задачи стабилизации вертикальной позы человека / И. В. Новожилов, А. В. Терехов, А. В. Забелин [и др.] // Математическое моделирование движений человека в норме и при некоторых видах патологии. — Москва : Изд-во механико-математического факультета МГУ. — 2005. — С. 7-20.

5. Моделирование процессов вставания экзоскелета из положения сидя / С. И. Савин, С. Ф. Яцун, А. С. Яцун, Г. Я. Пановко // Проблемы машиностроения и надежности машин. — 2016. — Т. 3. — С. 19-24.

6. Saypulaev, M. R. Development of the Lower Extremity Exoskeleton Dynamics Model Using in the Task of the Patient Verticalization / M. R. Saypulaev, Yu. Yu. Zuev, G. R. Saypulaev // Journal of Physics: Conference Series. — 2021. — Vol. 2096. — Art. 0120421. https://doi.org/10.1088/1742-6596/2096/1/012042

7. Zuev, Yu. Yu. Laws of Motion of the Lower Extremities and Structural-parametric Synthesis of Electro-Hydraulic Executive Modules of the Active Exoskeleton According to the Criterion of Energy Sufficiency / Yu. Yu. Zuev, M. R. Saypulaev, V. Doni // Journal of Physics: Conference Series. — 2021. — Vol. 2096. — Art. 012044. 10.1088/1742-6596/2096/1/012044

8. Яцун, С. Ф. Определение параметров приводов биоинженерных мехатронных модулей для экзоскелета нижних конечностей человека / С. Ф. Яцун, А. Н. Рукавицин // Известия Юго-Западного государственного университета. — 2012. — Т. 2, № 1. — С. 196-200.

9. Savin, S. I. Energy-Efficient Algorithm of Control of Exoskeleton Verticalization / S. I. Savin, A. S. Yatsun, S. F. Yatsun // Journal of Machinery Manufacture and Reliability. — 2017. — Vol. 46. — P. 512-517.

10. A Robust Adaptive-Fuzzy-Proportional-Derivative Controller for a Rehabilitation Lower Limb Exoskeleton / N. Aliman, R. Ramli, S. M. Haris [et al.] // International Journal of Engineering Science and Technology. — 2022. — Vol. 35. — Art. 101097. 10.1016/i.iestch.2022.101097

11. Adaptive Particle Swarm Optimization of PID Gain Tuning for Lower-Limb Human Exoskeleton in Virtual Environment / M. S. Amiri, R. Ramli, M. F. Ibrahim [et al.] // Mathematics. — 2020. — Vol. 8. — Art. 2040. 10.33 90/math8112040

12. Development and Control of an Electro-Hydraulic Actuator System for an Exoskeleton Robot / Dongyoung Lee, Buchun Song, Sang Yong Park, Yoon Su Baek // Applied Sciences. — 2019. — Vol. 9. — Art. 4295. 10.3390/app9204295

13. Lora-Millan, J. S. An IMUs-Based Extended Kalman Filter to Estimate Gait Lower Limb Sagittal Kinematics for the Control of Wearable Robotic Devices / J. S. Lora-Millan, A. F. Hidalgo, E. Rocon // IEEE Access. — 2021. — Vol. 9. — P. 144540-144554. 10.1109/ACCESS.2021.3122160

ns 14. Minimizing Human-Exoskeleton Interaction Force by Using Global Fast Sliding Mode Control /

Duong Mien Ka, Cheng Hong, Tran Huu Toan, Jing Qiu // International Journal of Control, Automation and J* Systems. — 2016. — Vol. 14. — P. 1064-1073. 10.1007/s12555-014-0395-7

' rH

15. Балакришнан, А. В. Теория фильтрации Калмана / А. В. Балакришнан. — Москва : Книга по > требованию. — 2021. — 164 с.

о

ТЗ

а £ л

Поступила в редакцию 11.07.2022 Поступила после рецензирования 01.08.2022 Принята к публикации 10.08.2022

Об авторах:

Сайпулаев Гасан Русланович, аспирант и ассистент кафедры «Робототехника, мехатроника, динамика и прочность машин» Национального исследовательского университета «МЭИ» (111250, РФ, г. Москва, ул. Красноказарменная, 14), ScopusID, ORCID, saypulaevgr@mail.ru

Сайпулаев Муса Русланович, аспирант кафедры «Робототехника, мехатроника, динамика и прочность машин» Национального исследовательского университета «МЭИ» (111250, РФ, г. Москва, ул. Красноказарменная, 14), ScopusID, ORCID, saypulaevmr@mail.ru

Меркурьев Игорь Владимирович, заведующий кафедрой «Робототехника, мехатроника, динамика и прочность машин» Национального исследовательского университета «МЭИ» (111250, РФ, г. Москва, ул. Красноказарменная, 14), доктор технических наук, доцент, ScopusID, ORCID, nir4s@ya.ru

Адамов Борис Игоревич, доцент кафедры «Робототехника, мехатроника, динамика и прочность машин» Национального исследовательского университета «МЭИ» (111250, РФ, г. Москва, ул. Красноказарменная, 14), кандидат физико-математических наук, доцент, ScopusID, ORCID, adamoff.b@yandex.га

Гарсиа Ройлан Бельо, аспирант кафедры «Робототехника, мехатроника, динамика и прочность машин» Национального исследовательского университета «МЭИ» (111250, РФ, г. Москва, ул. Красноказарменная, 14), ORCID, roilangarcia76@gmail.com

Заявленный вклад соавторов:

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

Конфликт интересов

Авторы заявляют об отсутствии конфликта интересов.

Все авторы прочитали и одобрили окончательный вариант рукописи.

а и к

К а

X и

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