CN106647260B - 一种基于相对阻抗的双臂遥操作自适应控制方法 - Google Patents
一种基于相对阻抗的双臂遥操作自适应控制方法 Download PDFInfo
- Publication number
- CN106647260B CN106647260B CN201611018463.6A CN201611018463A CN106647260B CN 106647260 B CN106647260 B CN 106647260B CN 201611018463 A CN201611018463 A CN 201611018463A CN 106647260 B CN106647260 B CN 106647260B
- Authority
- CN
- China
- Prior art keywords
- hand
- representing
- master
- slave
- parameter
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Active
Links
- 238000000034 method Methods 0.000 title claims abstract description 20
- 239000011159 matrix material Substances 0.000 claims description 21
- 238000013461 design Methods 0.000 claims description 10
- 230000005484 gravity Effects 0.000 claims description 9
- 230000001133 acceleration Effects 0.000 claims description 6
- 238000004891 communication Methods 0.000 claims description 4
- 238000013528 artificial neural network Methods 0.000 claims description 2
- 230000003044 adaptive effect Effects 0.000 abstract 1
- 238000013329 compounding Methods 0.000 abstract 1
- 238000012423 maintenance Methods 0.000 description 5
- 241000282414 Homo sapiens Species 0.000 description 3
- 230000000694 effects Effects 0.000 description 3
- 238000005516 engineering process Methods 0.000 description 2
- 238000012544 monitoring process Methods 0.000 description 2
- 230000009286 beneficial effect Effects 0.000 description 1
- 230000001276 controlling effect Effects 0.000 description 1
- 230000002079 cooperative effect Effects 0.000 description 1
- 230000000875 corresponding effect Effects 0.000 description 1
- 230000007547 defect Effects 0.000 description 1
- 238000001514 detection method Methods 0.000 description 1
- 238000010586 diagram Methods 0.000 description 1
- 230000007613 environmental effect Effects 0.000 description 1
- 238000002474 experimental method Methods 0.000 description 1
- 230000003993 interaction Effects 0.000 description 1
- 230000002452 interceptive effect Effects 0.000 description 1
- 238000004519 manufacturing process Methods 0.000 description 1
- 238000013507 mapping Methods 0.000 description 1
- 230000001537 neural effect Effects 0.000 description 1
- 238000013486 operation strategy Methods 0.000 description 1
- 230000002195 synergetic effect Effects 0.000 description 1
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B13/00—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion
- G05B13/02—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric
- G05B13/04—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric involving the use of models or simulators
- G05B13/042—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric involving the use of models or simulators in which a parameter or coefficient is automatically adjusted to optimise the performance
Landscapes
- Engineering & Computer Science (AREA)
- Health & Medical Sciences (AREA)
- Artificial Intelligence (AREA)
- Computer Vision & Pattern Recognition (AREA)
- Evolutionary Computation (AREA)
- Medical Informatics (AREA)
- Software Systems (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Manipulator (AREA)
- Feedback Control In General (AREA)
Abstract
本发明涉及一种基于相对阻抗的双臂遥操作自适应控制方法,通过分别设计主从端的控制器,在从端机械臂的控制过程中,通过相对阻抗的方法,实现辅助操作臂对主要操作臂的主动配合,从而在从端环境在一定范围内发生变化的情况下,可以适用于从端机器人不能完全的跟踪主端操作者的运动的情况,从端机器人根据主端操作者的协同效果和从端环境的变化,自适应的调整自身的位置、速度和作用力,从而实现双臂遥操的配合操作。
Description
技术领域
本发明属于空间遥操作领域,涉及一种基于相对阻抗的双臂遥操作自适应控制方法。
背景技术
随着空间探测的深入,大量的航天器面临在轨维护、组装和拆解的难题,不同航天器的在轨维护任务及运行监制等需求也日趋复杂和多样,遥操作技术作为一种远程操控技术,为空间在轨操作和维护提供了一个相对安全和简单、低成本的操作方式。在遥操作***中,人类通过人机交互界面、通信网络和远程机器人实现和远程环境的交互,实现对远端机器人的操控。空间操作的任务复杂度逐步提升,在空间装配、卫星和其他航天器的设备维修、空间生产和实验中需要越来越多的协同操作、多机配合。以空间站为例,其中就涉及到狭小空间环境复杂作业,舱外各关键部位,关键设备运行状态的及时监测、预警、部件更换乃至维修维护等任务,但是由目前单个机械臂执行特定任务的方式难以满足这种复杂空间任务的需求,而采用多个机械臂协同操作的方式不仅可以满足任务的需求,而且具有操作效率高,操作范围大,负载能力强的优点。
采用多机械臂遥操作的方式完成空间在轨任务,其难点在于如何让空间机械臂像人一样的完成配合,尤其是在双机械臂与操作对象存在力接触操作的时候,机器人需要在人的指引下根据环境的不同适当的自行调整,以保证操作的可靠性。
发明内容
要解决的技术问题
为了避免现有技术的不足之处,本发明提出一种基于相对阻抗的双臂遥操作自适应控制方法,针对在双臂遥操作协同控制过程中,从端机械臂受到环境变化和其他操作臂操作效果的影响,容易导致双臂的协同效果较差的问题。
技术方案
一种基于相对阻抗的双臂遥操作自适应控制方法,其特征在于步骤如下:
步骤1:建立双人双手操作的动力学模型
其中,Mmi为主手i的惯性矩阵,为主手i的向心力和科式力,Gmi(qmi)为主手i的重力参数,i=1,2;dmi(t)为主手i在t时刻的扰动项,Fmsi(t)表示t时刻的控制力,Fhi(t)表示主手i操作者作用在末端点的作用力,表示主手i的雅克比矩阵,Msi为从手机械臂i的惯性矩阵,为从手机械臂i的向心力和科式力,Gsi(qsi)为从手机械臂i的重力参数,i=1,2;dsi(t)为从手i在t时刻的扰动项,Fcsi(t)表示t时刻的控制力,Fsi(t)表示从手i操作者作用在环境的作用力表示从手i的雅克比矩阵,和分别表示主手i在关节坐标系下的角度、角速度和角加速度,和分别表示从手i在关节坐标系下的角度、角速度和角加速度,由于在空间环境下,受到发射过程和地球重力的影响,参数Msi、和Gsi(qsi),i=1,2,相比于地面测量的参数都会发生一定的变化,所以令 和其中和分别表示对参数Msi、Csi和Gsi的初始估计值,令表示机器人***动力学的不确定项;
步骤2:主手控制器设计
定义γi=qsi(t-T)-qmi(t),其中,T表示主从端的通信时延,定义则主手i的控制器设计为:
其中,kmi为一个正数,表示***的控制参数,参数kmi的取值使得***为稳定的,ηmi为***的鲁棒项,用来减弱参数εi对***稳定性的影响,其中ηmi的表达式如下:
ηmi=sat(εi,μmi)
其中,μmi为一个正数,表示对于εi限制的阈值;
步骤3:从手控制器设计
主要从手的控制器设计为:
其中,表示从手1通过RBF神经网络对参数ρ的估计值,定义且该值有界其中|A|符号表示对值A的绝对值,ηρ1为一个正数,ηs1的表达式如下
其中,μs1为一个正数,表示对于r1限制的阈值,δs1为一个较小的比例系数,通常情况下,设δs1=1。e1=qm1(t-T)-qs1(t),表示r1的导数,k1表示比例系数;
配合从手的控制器为:
其中,I2×1表示2×1的单位矩阵,Jcs2=[Js2 Js1],Js1和Js2分别表示从手1和从手2的雅克比矩阵,表示Jcs2的伪逆,表示从手2的雅克比矩阵的导数矩阵,表示的伪逆,XR=xs2(t)-xs1(t),
其中:Dx=qm2(t-T)-qm1(t-T)-(qs2(t)-qs1(t)), 表示对参数ρ2的估计值,ηs2=(ηρ2+δs2)·sat(Dx,εs2),其中,
其中,μs2为一个正数,表示对于Dx限制的阈值,δs2为一个的比例系数,设δs2=1;ηρ2表示该值有界的上界,其中,e2=qm2(t-T)-qs2(t),表示r2的导数。表示Js2的转置;
步骤4:以步骤2设计的主手控制器设计和步骤3设计的从手控制器控制双臂遥操作运动。
有益效果
本发明提出的一种基于相对阻抗的双臂遥操作自适应控制方法,通过分别设计主从端的控制器,在从端机械臂的控制过程中,通过相对阻抗的方法,实现辅助操作臂对主要操作臂的主动配合,从而在从端环境在一定范围内发生变化的情况下,可以适用于从端机器人不能完全的跟踪主端操作者的运动的情况,从端机器人根据主端操作者的协同效果和从端环境的变化,自适应的调整自身的位置、速度和作用力,从而实现双臂遥操的配合操作。
与现有技术相比,本发明具有以下有益效果:
1)具备较高的灵活性,在非结构化环境之下,能以操作者的协同操作为标准,自主的完成相互协同操作,从而完成单纯的位置跟踪控制所不能达到的效果。
具备更高的可靠性,相比于自主操作而言,其控制指令是由操作者实时发出的,可以根据实际情况调整其操作策略,能够适应操作环境变化对操作可靠性的影响。
附图说明
图1:双人共享双臂空间机器人遥操作控制***示意图
具体实施方式
现结合实施例、附图对本发明作进一步描述:
本发明考虑空间双臂机器人在非结构化空间环境下执行在轨任务,双臂机器人与操作者双臂之间存在对应关系,即操作者双手和空间机器人之间存在操作映射。在理想操作过程中,机器人的双臂之间的相对位置关系与操作者的双手的相对位置关系能保持一致,且能根据操作操作者双臂的配合变化和环境的改变,自适应的改变双臂的位置关系,从而实现双臂的配合操作如图1所示。它包括以下三个步骤:
1、建立双人双手操作的动力学模型:
其中,Mmi,和Gmi(qmi),i=1,2分别为主手i的惯性矩阵、向心力和科式力和重力参数,dmi(t)为主手i在t时刻的扰动项,Fmsi(t)表示t时刻的控制力,Fhi(t)表示主手i操作者作用在末端点的作用力表示主手i的雅克比矩阵,Msi,和Gsi(qsi),i=1,2分别为从手机械臂i的惯性矩阵、向心力和科式力和重力参数,dsi(t)为从手i在t时刻的扰动项,Fcsi(t)表示t时刻的控制力,Fsi(t)表示从手i操作者作用在环境的作用力表示从手i的雅克比矩阵,和分别表示主手i在关节坐标系下的角度、角速度和角加速度,和分别表示从手i在关节坐标系下的角度、角速度和角加速度,由于在空间环境下,受到发射过程和地球重力的影响,参数Msi、和Gsi(qsi),i=1,2,相比于地面测量的参数都会发生一定的变化,所以令和其中和分别表示对参数Msi、Csi和Gsi的初始估计值,令表示机器人***动力学的不确定项。
2、主手控制器设计
定义γi=qsi(t-T)-qmi(t),其中,T表示主从端的通信时延,定义则主手i的控制力设计为:
其中,kmi为一个正数,表示***的控制参数,通过调节参数kmi可以保证***的稳定性,ηmi为***的鲁棒项,用来减弱参数εi对***稳定性的影响,其中ηmi的表达式如下:
ηmi=δmi·sat(εi,μmi)
其中,μmi为一个正数,表示对于εi限制的阈值,δmi为一个较小的比例系数,通常情况下δmi=1。
3、从手控制器设计
从手端的两个从手分为主要从手和配合从手,主要从手(从手1)的控制力设计为:
其中,表示从手1通过RBF神经网络对参数ρ的估计值,定义且该值有界其中|A|符号表示对值A的绝对值,ηρ1为一个正数,ηs1的表示是表达式如下
其中,μs1为一个正数,表示对于r1限制的阈值,δs1为一个较小的比例系数,通常情况下,设δs1=1。表示r1的导数,k1表示比例系数。
配合从手(从手2)的控制力为
其中,I2×1表示2×1的单位矩阵,Jcs2=[Js2 Js1],Js1和Js2分别表示从手1和从手2的雅克比矩阵,表示Jcs2的伪逆,表示从手2的雅克比矩阵的导数矩阵,表示的伪逆,XR=xs2(t)-xs1(t),
其中Dx=qm2(t-T)-qm1(t-T)-(qs2(t)-qs1(t)), 表示对参数ρ2的估计值,ηs2=(ηρ2+δs2)·sat(Dx,εs2),其中,
其中,μs2为一个正数,表示对于Dx限制的阈值,δs2为一个较小的比例系数,通常情况下,设δs2=1。ηρ2表示该值有界的上界,其中,e2=qm2(t-T)-qs2(t),表示r2的导数。表示Js2的转置。
Claims (1)
1.一种基于相对阻抗的双臂遥操作自适应控制方法,其特征在于步骤如下:
步骤1:建立双人双手操作的动力学模型
其中,Mmi为主手i的惯性矩阵,为主手i的向心力和科式力,Gmi(qmi)为主手i的重力参数,i=1,2;dmi(t)为主手i在t时刻的扰动项,Fmsi(t)表示t时刻的控制力,Fhi(t)表示主手i操作者作用在末端点的作用力,表示主手i的雅克比矩阵,Msi为从手机械臂i的惯性矩阵,为从手机械臂i的向心力和科式力,Gsi(qsi)为从手机械臂i的重力参数,i=1,2;dsi(t)为从手i在t时刻的扰动项,Fcsi(t)表示t时刻的控制力,Fsi(t)表示从手i操作者作用在环境的作用力表示从手i的雅克比矩阵,和分别表示主手i在关节坐标系下的角度、角速度和角加速度,和分别表示从手i在关节坐标系下的角度、角速度和角加速度,由于在空间环境下,受到发射过程和地球重力的影响,参数Msi、和Gsi(qsi),i=1,2,相比于地面测量的参数都会发生一定的变化,所以令 和其中和分别表示对参数Msi、Csi和Gsi的初始估计值,令表示机器人***动力学的不确定项;
步骤2:主手控制器设计
定义γi=qsi(t-T)-qmi(t),其中,T表示主从端的通信时延,定义则主手i的控制器设计为:
其中,kmi为一个正数,表示***的控制参数,参数kmi的取值使得***为稳定的,ηmi为***的鲁棒项,用来减弱参数εi对***稳定性的影响,其中ηmi的表达式如下:
ηmi=sat(εi,μmi)
其中,μmi为一个正数,表示对于εi限制的阈值;
步骤3:从手控制器设计
主要从手的控制器设计为:
其中,表示从手1通过RBF神经网络对参数ρ1的估计值,定义且该值有界其中|A|符号表示对值A的绝对值,ηρ1为一个正数,ηs1的表达式如下
其中,μs1为一个正数,表示对于r1限制的阈值,δs1为一个较小的比例系数,设δs1=1;e1=qm1(t-T)-qs1(t),表示r1的导数,k1表示比例系数;
配合从手的控制器为:
其中:I2×1表示2×1的单位矩阵,Jcs2=[Js2 Js1],Js1和Js2分别表示从手1和从手2的雅克比矩阵,表示Jcs2的伪逆,表示从手2的雅克比矩阵的导数矩阵,表示的伪逆,XR=xs2(t)-xs1(t),
其中:Dx=qm2(t-T)-qm1(t-T)-(qs2(t)-qs1(t)), 表示对参数ρ2的估计值,ηs2=(ηρ2+δs2)·sat(Dx,μs2),其中,
其中,μs2为一个正数,表示对于Dx限制的阈值,δs2为一个比例系数,设δs2=1;ηρ2表示的上界,其中,e2=qm2(t-T)-qs2(t),表示r2的导数;表示Js2的转置;
步骤4:以步骤2设计的主手控制器设计和步骤3设计的从手控制器控制双臂遥操作运动。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201611018463.6A CN106647260B (zh) | 2016-11-18 | 2016-11-18 | 一种基于相对阻抗的双臂遥操作自适应控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201611018463.6A CN106647260B (zh) | 2016-11-18 | 2016-11-18 | 一种基于相对阻抗的双臂遥操作自适应控制方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN106647260A CN106647260A (zh) | 2017-05-10 |
CN106647260B true CN106647260B (zh) | 2019-08-09 |
Family
ID=58807952
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201611018463.6A Active CN106647260B (zh) | 2016-11-18 | 2016-11-18 | 一种基于相对阻抗的双臂遥操作自适应控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN106647260B (zh) |
Families Citing this family (9)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN107553485B (zh) * | 2017-07-13 | 2020-05-12 | 西北工业大学 | 一种人机交互过程中动态虚拟夹具的生成方法 |
CN107422639B (zh) * | 2017-07-13 | 2020-07-14 | 西北工业大学 | 一种基于时间延迟估计的双边遥操作控制方法 |
CN107932506B (zh) * | 2017-11-15 | 2020-10-16 | 电子科技大学 | 一种力反馈双边遥操作稳定控制方法 |
CN108227497B (zh) * | 2018-01-11 | 2021-01-08 | 燕山大学 | 一种考虑***性能受限下网络化遥操作***的控制方法 |
CN108803344B (zh) * | 2018-07-25 | 2019-11-22 | 西北工业大学 | 一种基于模态切换的机器人双边遥操作对称预测控制方法 |
CN110587569A (zh) * | 2019-09-09 | 2019-12-20 | 西安天圆光电科技有限公司 | 一种双臂机器人协同遥操作控制方法 |
CN112363389B (zh) * | 2020-11-11 | 2022-07-05 | 西北工业大学 | 一种针对单主多从遥操作模式的共享自主编队规划控制方法 |
CN113500597B (zh) * | 2021-07-08 | 2022-10-04 | 南京工业大学 | 基于力翻译机制的多端遥操作滑模阻抗控制方法 |
WO2024050729A1 (en) * | 2022-09-07 | 2024-03-14 | Shanghai Flexiv Robotics Technology Co., Ltd. | Robot teleoperation system and method |
Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101930216A (zh) * | 2010-08-27 | 2010-12-29 | 东南大学 | 基于主从参考模型的遥操作机器人自适应控制方法 |
CN105904461A (zh) * | 2016-05-16 | 2016-08-31 | 西北工业大学 | 一种基于径向基函数的神经网络自适应遥操作控制方法 |
Family Cites Families (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO2014088994A1 (en) * | 2012-12-03 | 2014-06-12 | Abb Technology Ag | Teleoperation of machines having at least one actuated mechanism |
-
2016
- 2016-11-18 CN CN201611018463.6A patent/CN106647260B/zh active Active
Patent Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101930216A (zh) * | 2010-08-27 | 2010-12-29 | 东南大学 | 基于主从参考模型的遥操作机器人自适应控制方法 |
CN105904461A (zh) * | 2016-05-16 | 2016-08-31 | 西北工业大学 | 一种基于径向基函数的神经网络自适应遥操作控制方法 |
Non-Patent Citations (3)
Title |
---|
"A Novel Shared Structure for Dual User Systems with Unknown Time-Delay Utilizing Adaptive Impedance Control";M.Shahbazi 等;《2011 IEEE International Conference on Robotics and Automation》;20110513;全文 * |
"空间机器人遥操作关键技术综述与展望";张涛 等;《空间控制技术与应用》;20141231;第40卷(第6期);全文 * |
"面向空间遥操作的非对称双人共享控制及其性能分析";鹿振宇 等;《航空学报》;20160225;第37卷(第2期);全文 * |
Also Published As
Publication number | Publication date |
---|---|
CN106647260A (zh) | 2017-05-10 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN106647260B (zh) | 一种基于相对阻抗的双臂遥操作自适应控制方法 | |
He et al. | Neural-learning-based control for a constrained robotic manipulator with flexible joints | |
CN109358506B (zh) | 一种基于干扰观测器的自适应模糊遥操作控制方法 | |
Yang et al. | Neural control of bimanual robots with guaranteed global stability and motion precision | |
Mohan et al. | Indirect adaptive control of an autonomous underwater vehicle-manipulator system for underwater manipulation tasks | |
CN109015634B (zh) | 基于性能函数的多臂遥操作机器人力/位置混合控制方法 | |
Liu et al. | Adaptive neural control for dual-arm coordination of humanoid robot with unknown nonlinearities in output mechanism | |
Mohan et al. | Coordinated motion control in task space of an autonomous underwater vehicle–manipulator system | |
Yu et al. | Modeling and observer-based augmented adaptive control of flexible-joint free-floating space manipulators | |
Li et al. | Dynamic balance optimization and control of quadruped robot systems with flexible joints | |
CN107422639B (zh) | 一种基于时间延迟估计的双边遥操作控制方法 | |
CN109240343B (zh) | 一种绳系机器人逼近目标位姿一体化控制方法 | |
CN110497415B (zh) | 一种基于干扰观测器的多机械臂***的一致控制方法 | |
Lu et al. | High‐gain nonlinear observer‐based impedance control for deformable object cooperative teleoperation with nonlinear contact model | |
Shi et al. | Coordinated control of a dual-arm space robot: Novel models and simulations for robotic control methods | |
Rajappa et al. | A control architecture for physical human-UAV interaction with a fully actuated hexarotor | |
Xia et al. | Hybrid force/position control of industrial robotic manipulator based on Kalman filter | |
Zhao et al. | Adaptive finite-time backstepping control for a two-wheeled mobile manipulator | |
CN110587569A (zh) | 一种双臂机器人协同遥操作控制方法 | |
Ismail et al. | Dynamic region boundary-based control scheme for multiple autonomous underwater vehicles | |
Zhou et al. | Neural network-based variable stiffness impedance control for internal/external forces tracking of dual-arm manipulators under uncertainties | |
Solea et al. | Sliding-mode real-time mobile platform control in the presence of uncertainties | |
Lu et al. | Adaptive robust control for bimanual cooperative contact teleoperation with relative jacobian matrix | |
Liu et al. | Adaptive control for bilateral teleoperators under time-varying communication delays | |
Ayyıldız et al. | Fault Tolerant Control of Wheeled Mobile Robots Using Adaptive Sliding Mode Controller |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PB01 | Publication | ||
PB01 | Publication | ||
SE01 | Entry into force of request for substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant |