人机交互遥操作机器人软体手位置跟踪设计与实现
Design and implementation of soft hand position tracking for human-computer interactive teleoperation robot
通讯作者:
收稿日期: 2022-09-13 修回日期: 2022-11-17
基金资助: |
|
Received: 2022-09-13 Revised: 2022-11-17
作者简介 About authors
杨淦华(1995—),男,江西赣州人,硕士生,从事水下有缆机器人设计与遥操作软体手控制研究,E-mail:
关键词:
Keywords:
本文引用格式
杨淦华, 曾庆军, 韩春伟, 黄鑫, 戴晓强.
YANG Ganhua, ZENG Qingjun, HAN Chunwei, HUANG Xin, DAI Xiaoqiang.
随着人类向外太空、深海探索,能够代替人类在危险或有害环境中远程作业的遥操作机器人成为热门的研究前沿。相较于普通机器人,遥操作机器人的控制方式从全自主方式转向交互方式,操作者在主端远程向从端发送信号,从端机器人接收信号后完成相应的操作[1]。在未知环境中,遥操作机器人更具有实际应用意义。因此,大量学者参与到遥操作机器人技术的研究开发中。
由于传统刚体机器人存在设计过于复杂、自由度有限、无法适应复杂场景及存在危险因素等缺陷,其刚性结构亟须改进。软体机器人由软质材料制成,相较于刚体机器人具有柔软、可连续变形等特点,在抓取软体物体、易碎物体时优势明显,可适应更为复杂、狭小空间中的作业[3]。软体手因具有对复杂场景的适应性以及柔顺性,搭配软体机器人具有广阔的应用前景。
1 主从软体手控制系统的构成及工作原理
图1
图1
人机交互遥操作机器人主从软体手控制系统的构成及工作原理
Fig.1
Composition and working principle of master-slave soft hand control system for human-computer interactive teleoperation robot
2 软体手指动力学建模
鉴于软体从手各手指的运动方式相同,仅腔室和关节的数量稍有区别,为了简化问题,本文以软体食指的末端位置跟踪为例展开分析。软体食指的三维模型如图2所示。
图2
图3
2.1 基于假设模态法的软体手指建模
图3所示的软体食指含有3根柔性连杆,每根连杆的关节位于连杆首端,可驱动连杆整体转动;连杆3的末端,即软体食指整体的末端处于自由状态,只受软体食指自身弯曲的影响。由于柔性连杆的截面积相对于软体食指整体的长度而言很小,以及柔性连杆中均匀嵌入了金属颗粒来增大刚度,且软体食指只在一个平面上作横向弯曲运动,弯曲变形集中在关节处,而柔性连杆的变形较小,故柔性连杆具有Euler-Bernoulli梁特性[11]。忽略重力的作用,软体食指只在二维平面内作弯曲运动,其为一个时变非线性分布参数系统,包含任意个自由度。在Rayleigh-Ritz法基础上产生的假设模态法[12],通过拉格朗日方程和汉密尔顿原理以及去除高阶模态的方法得到最终的离散动力方程,最适用于本文的软体手指建模。如图4所示,将原点
图4
图4
软体食指弯曲过程涉及的变量
Fig.4
Variables involved in the bending process of soft index finger
根据图4,可得:
式中:
由此可得,某一时刻下
式中:
取
式中:
将
定义软体食指末端位置偏移向量
其中:
将
2.2 软体手指末端位置跟踪分析
设在理想状态下软体食指末端轨迹为
3 软体手指末端位置跟踪控制器设计与仿真
由
3.1 软体手指状态预测输出方程
设控制变量为
将
设软体食指的状态变量为:
设采样时间为
使用欧拉积分法将
令
其中:
式中: F9为元素全为1的9阶矩阵。
3.2 最优控制律和最优驱动力矩解算
由于软体食指状态预测模型存在建模误差,控制器的性能会有所下降,因此需引入实际数据对开环预测输出的结果进行修正[17]。首先,令
定义性能指标
式中:
结合力矩加权矩阵
设
根据
比较预测精度,实际输出的影响在文献[18]中没有被考虑,本文在模型输出之后加入反馈矫正,将模型输出结果
3.3 软体手指末端位置跟踪仿真结果
修改软体食指状态预测模型中的某些参数,使其区别于真实参数,用于模拟误差,从而检验模型预测控制器的有效性。现给定三连杆软体手指状态预测模型计算所需的参数,具体如下:连杆密度
给定理想轨迹(即软体主手末端轨迹)相关参数:开始时间
令本文设计的模型预测控制器为
图5
图5
软体食指末端位置跟踪仿真结果对比
Fig.5
Comparison of end position tracking simulation results of soft index finger
表1 2种控制器的性能评价指标对比
Table 1
控制器 | 跟踪误差绝对值/rad | 末端偏移量绝对值/mm |
---|---|---|
1.243 2 | 0.583 5 | |
4.592 2 | 0.558 3 |
4 实验验证
4.1 实验平台搭建
搭建人机交互遥操作机器人主从软体手控制系统。该系统分为软体主手控制系统、上位机、软体从手控制系统三部分。其中,软体主手控制系统与软体从手控制系统的构成类似,主要区别在于软体主手中嵌入的是弯曲传感器,软体从手中嵌入的是压力传感器。如图6所示,软体主手控制系统由软体主手、24 V锂电池、气泵组、电磁阀组和控制板组成。其中,气泵组由10个Kamoer EDLP600-D24B气泵组成,每2个气泵负责1根软体手指的充/放气;电磁阀组由5个Ruhfus VT307V-5G1-02电磁阀组成,负责控制气路的切换;控制板最小系统中芯片的型号为STM32F103C8T6,能够确保系统的稳定运行并且准确、高效、高速地完成各个模块之间的通信和数据处理,从而完成抓取功能。
图6
图7
图7
主从软体手控制系统实验平台
Fig.7
Master-slave soft hand control system experimental platform
4.2 软体从手跟随抓握实验
图8
图8
软体从手食指跟随软体主手食指
Fig.8
Soft slave hand index finger follows soft master hand index finger
图9
图9
软体从手跟随软体主手抓握方形物体
Fig.9
Soft slave hand follows soft master hand to grasp square object
图10
图10
软体从手跟随软体主手抓握圆柱形物体
Fig.10
Soft slave hand follows soft master hand to grasp cylindrical object
图11
图11
软体主手和软体从手食指的弯曲角度对比
Fig.11
Comparison of bending angle of index finger between soft master hand and soft slave hand
表2 前6 s内软体主手和软体从手食指的弯曲角度
Table 2
时间/s | 食指弯曲角度/(°) | |
---|---|---|
软体主手 | 软体从手 | |
0 | 0 | 0 |
0.6 | 15 | 0 |
1.2 | 28 | 16 |
1.8 | 53 | 29 |
2.4 | 70 | 55 |
3.0 | 74 | 71 |
3.6 | 72 | 75 |
4.2 | 74 | 72 |
4.8 | 71 | 74 |
5.4 | 75 | 71 |
6.0 | 72 | 75 |
5 结束语
本文针对人机交互遥操作机器人主从软体手的位置跟踪控制问题,以软体食指末端位置跟踪为例,采用假设模态法进行建模,并通过引入模型预测控制算法,解决了软体从手跟踪软体主手性能差的问题。仿真结果表明,所设计的模型预测控制器能有效解决软体手指因模型失配而引起的控制精度下降问题;实验结果表明,所设计的主从软体手控制系统整体的运行效果良好。研究结果为人机交互遥操作机器人软体手的跟踪控制提供了参考。
参考文献
基于软体手的机器人遥操作人机交互系统研制
[J].
Development of robot teleoperation human-computer interaction system based on soft hand
[J].DOI:10.19708 /j.ckjs.2023.01.204 [本文引用: 1]
Design, fabrication and control of soft robots
[J].
基于假设模态法的柔性机械臂瞬时变形响应分析
[J].
Analysis of transient deformation response for flexible robotic manipulator using assumed mode method
[J].DOI:10.14016/j.cnki.1001-9227.2019.12.065 [本文引用: 1]
Soft robotic glove for combined assistance and at-home rehabilitation
[J].
A novel type of compliant and underactuated robotic hand for dexterous grasping
[J].
Learning dexterous manipulation for a soft robotic hand from human demonstration
[C]//
基于柔性腕手的最优抓取规划研究
[J].
Research on optimal grasping planning based on flexible wrist-hand
[J].DOI:10.3785/j.issn.1006-754X.2020.00.045 [本文引用: 1]
驱控一体7DOF机械臂位置控制技术研究
[J].
Position control technology of drive integrated 7DOF manipulator
[J].DOI:10.3969/j.issn.1001-4551.2022.12.015 [本文引用: 1]
力觉临场感遥操作机器人(1):技术发展与现状
[J].
Force telepresence telerobot (1): review of the history and development
[J].DOI:10.13878/j.cnki.jnuist.2013.01.001 [本文引用: 2]
Predictive end-point trajectory control of elastic manipulators
[J].
基于虚拟现实的机器人遥操作关键技术研究
[J].
Survey on robot teleoperation based on virtual reality
[J].DOI:10.3969/j.issn.0254-3087.2017.10.001 [本文引用: 1]
软体机器人:结构、驱动、传感与控制
[J].
Soft robotics: structure, actuation, sensing and control
[J].DOI:10.3901/jme.2017.13.001 [本文引用: 1]
Feedback control of soft robot actuators via commercial flex bend sensors
[J].
软体机械手遥操作系统的设计与分析
[J].
Design and analysis of soft manipulator teleoperation systems
[J].DOI:10.3969/j.issn.1004-132X.2020.16.009 [本文引用: 1]
Universal soft pneumatic robotic gripper with variable effective length
[C]//
基于弯曲度预测模型的软体手人机交互控制
[J].
Human-computer interaction control of soft hand based on bending prediction model
[J].DOI:10.19557/j.cnki.1001-9944.2022.07.009 [本文引用: 1]
一种柔性机械臂末端轨迹跟踪的预测控制算法
[J].
Real time predictive control algorithm for endpoint trajectory tracking of flexible manipulator
[J].DOI:10.3785/j.issn.1008-973X.2010.02.009 [本文引用: 2]
气动伺服机械手的预测模糊自整定PID控制研究
[J].
The research of predictive fuzzy self-tuning PID control in pneumatic servo manipulator
[J].DOI:10.3969/j.issn.1001-3997.2009.01.066 [本文引用: 1]
/
〈 |
|
〉 |
