CN109015634B - 基于性能函数的多臂遥操作机器人力/位置混合控制方法 - Google Patents
基于性能函数的多臂遥操作机器人力/位置混合控制方法 Download PDFInfo
- Publication number
- CN109015634B CN109015634B CN201810820246.1A CN201810820246A CN109015634B CN 109015634 B CN109015634 B CN 109015634B CN 201810820246 A CN201810820246 A CN 201810820246A CN 109015634 B CN109015634 B CN 109015634B
- Authority
- CN
- China
- Prior art keywords
- slave
- representing
- force
- hand
- master
- 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 25
- 238000013461 design Methods 0.000 claims abstract description 10
- 239000011159 matrix material Substances 0.000 claims description 21
- 230000005484 gravity Effects 0.000 claims description 9
- 238000004891 communication Methods 0.000 claims description 6
- 230000001133 acceleration Effects 0.000 claims description 5
- 238000013528 artificial neural network Methods 0.000 claims description 3
- 230000008878 coupling Effects 0.000 abstract description 3
- 238000010168 coupling process Methods 0.000 abstract description 3
- 238000005859 coupling reaction Methods 0.000 abstract description 3
- 238000010586 diagram Methods 0.000 description 2
- 230000009286 beneficial effect Effects 0.000 description 1
- 238000011217 control strategy Methods 0.000 description 1
- 230000007547 defect Effects 0.000 description 1
- 230000000694 effects Effects 0.000 description 1
- 238000005516 engineering process Methods 0.000 description 1
- 238000012423 maintenance Methods 0.000 description 1
- 230000005658 nuclear physics Effects 0.000 description 1
- 238000012546 transfer Methods 0.000 description 1
- 230000001052 transient effect Effects 0.000 description 1
Images
Classifications
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J9/00—Programme-controlled manipulators
- B25J9/16—Programme controls
- B25J9/1628—Programme controls characterised by the control loop
- B25J9/1633—Programme controls characterised by the control loop compliant, force, torque control, e.g. combined with position control
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J9/00—Programme-controlled manipulators
- B25J9/16—Programme controls
- B25J9/1602—Programme controls characterised by the control system, structure, architecture
- B25J9/1605—Simulation of manipulator lay-out, design, modelling of manipulator
Landscapes
- Engineering & Computer Science (AREA)
- Robotics (AREA)
- Mechanical Engineering (AREA)
- Automation & Control Theory (AREA)
- Feedback Control In General (AREA)
Abstract
本发明涉及一种基于性能函数的多臂遥操作机器人力/位置混合控制方法,考虑到实际操作过程中,操作对象、机械臂在操作过程中的力/位置耦合的情况,通过分别设计主从端的控制器,在从端机械臂的控制过程中,通过预设计机械臂的性能函数,设计从端机械臂的力位置混合控制器,实现操作过程中,目标受到一定外界扰动情况下,仍能通过机械臂的控制消减扰动的影响,同时自适应的调整自身的位置、速度和作用力,保证***操作的稳定性,从而实现多臂遥操的配合操作。
Description
技术领域
本发明属于遥操作领域,涉及一种基于性能函数的多臂遥操作机器人力/位置混合控制方法。
背景技术
目前机器人广泛应用于工业、深海、空间、医疗和核物理等领域,代替人完成组装、检修、操作等任务,避免这些危险环境对人的损伤,并在一定程度上降低任务完成的成本。但是由于机器人的智能有限,在时变或者未知的操作环境中,无法自主完成操作任务,这就需要操作人员通过“人在回路”的方式通过遥操作的方式操作机器人完成。多机械臂遥操作技术目前已经在医学领域得到一定的应用,例如“达芬奇”手术机器人等,但是这些多臂遥操作机器人多数采用位置控制的方法,但是对于操作过程中并未对接触力进行控制,这样容易导致操作作用力/力矩过大的情况,从而超出执行器能力的范围,甚至造成机械臂的损坏。
发明内容
要解决的技术问题
为了避免现有技术的不足之处,本发明提出一种基于性能函数的多臂遥操作机器人力/位置混合控制方法,对在多臂遥操作协同控制过程中,从端机械臂受到外界扰动、操作对象与机械臂力/位置耦合、目标不可测机动等条件的影响,提出一种基于性能函数的多臂遥操作机器人力/位置混合控制方法。
技术方案
一种基于性能函数的多臂遥操作机器人力/位置混合控制方法,其特征在于步骤如下:
步骤1:建立多人遥操作操作者和的动力学模型
其中,Mmi,和Gmi(qmi),i=1,2,...,n分别为主手i的惯性矩阵、向心力和科式力和重力参数,n表示操作者的数目,dmi(t)为主手i在t时刻的扰动项,且满足|dmi(t)|<δmi,τmsi(t)表示t时刻的控制力矩,Fhi(t)表示主手i操作者作用在末端点的作用力,表示主手i的雅克比矩阵,Msi,和Gsi(qsi),i=1,2,...,n分别为从手机械臂i的惯性矩阵、向心力和科式力和重力,操作者数目和机械臂相同,n表示机械臂的数目,dsi(t)为从手i在t时刻的扰动项,且满足|dsi(t)|<δsi,τcsi(t)表示t时刻的控制力矩,Fsi(t)表示从手i操作者作用在环境的作用力表示从手i的雅克比矩阵,qmi,和分别表示主手i在关节坐标系下的角度、角速度和角加速度,qsi,和分别表示从手i在关节坐标系下的角度、角速度和角加速度;
步骤2:建立操作对象的动力学模型
步骤3:设计从手控制器
受到操作环境的变化,从端机械臂的惯性参数及其相应的矩阵Msi、和Gsi(qsi)在实际操作过程中都会存在不确定项,令和其中和分别表示对参数Msi、Csi和Gsi的初始估计值,ΔMsi、ΔCsi和ΔGsi分别表示不确定值,令表示机器人***动力学的不确定项;
从端的力位混合控制器:
其中,ei=qmi(t-T)-qsi(t),T表示主从端的通信时延,qmi(t-T)表示从主端经过时延T之后传递到从端的信号,表示矩阵Jsi(qsi)的广义逆矩阵,k1表示一个常数,κ1(t)表示与性能函数相关的时变系数,其具体表达式为:
其中,μsi为一个正数,表示对于ei限制的阈值,δsi为一个比例系数,通常情况下δsi=1;
步骤4:主手控制器设计
其中,kmi为一个正数,表示***的控制参数,通过调节参数kmi可以保证***的稳定性,ηmi为***的鲁棒项,用来减弱参数εi对***稳定性的影响,其中ηmi的表达式如下:
ηmi=δmi·sat(εi,μmi)
其中,μmi为一个正数,表示对于εi限制的阈值,δmi为一个比例系数,通常情况下δmi=1;
步骤5:以步骤3得到的从手控制器和步骤4得到的主手控制器输入步骤1和步骤2的动力学模型中,实现多臂遥操作机器人力/位置混合控制。
有益效果
本发明提出的一种基于性能函数的多臂遥操作机器人力/位置混合控制方法,考虑到实际操作过程中,操作对象、机械臂在操作过程中的力/位置耦合的情况,通过分别设计主从端的控制器,在从端机械臂的控制过程中,通过预设计机械臂的性能函数,设计从端机械臂的力位置混合控制器,实现操作过程中,目标受到一定外界扰动情况下,仍能通过机械臂的控制消减扰动的影响,同时自适应的调整自身的位置、速度和作用力,保证***操作的稳定性,从而实现多臂遥操的配合操作。本发明通过设置性能函数,保证操作的瞬态和稳态性能,保证相对位姿控制***在存在外部干扰不确定性和非合作目标不可测机动的条件下仍能满足预先设计的性能要求。
与现有技术相比,本发明具有以下有益效果:
1)具备较高的灵活性,在非结构化环境之下,完成多机械臂的协同操作任务,相比于单机械臂遥操作操作效率较高,负载较大,相比于自主操作而言,其控制指令是由操作者实时发出的,可以适应操作环境变化对操作可靠性的影响。
具备更高的可靠性,由于采取了力/位置混合控制的策略,在操作的时候不会因为接触力过大对目标造成破坏,同时也保护机械臂自身的安全。
附图说明
图1:多操作者多臂遥操作机器人控制***示意图
图2:跟踪误差与性能函数之间关系的示意图
具体实施方式
现结合实施例、附图对本发明作进一步描述:
本发明考虑空间多臂机器人在非结构化空间环境下协同操作一个位置目标,多臂机器人与多名操作者之间存在对应关系,即操作者数目和空间机器人臂数相同。如图1所示,在操作过程中,操作者通过操作独立的手控器将控制信息传递给计算机,计算机通过网络回路将控制指令传递给机械臂,机械臂在操作之后将传感器测量的位置、力信息传递给控制器,再由控制器将反馈信息反映到每个操作者的操作器上。它包括以下四个步骤:
1、建立多人遥操作操作者和的动力学模型:
其中,Mmi,和Gmi(qmi),i=1,2,...,n分别为主手i的惯性矩阵、向心力和科式力和重力参数,n表示操作者的数目,dmi(t)为主手i在t时刻的扰动项,且满足|dmi(t)|<δmi,τmsi(t)表示t时刻的控制力矩,Fhi(t)表示主手i操作者作用在末端点的作用力,表示主手i的雅克比矩阵,Msi,和Gsi(qsi),i=1,2,...,n分别为从手机械臂i的惯性矩阵、向心力和科式力和重力,操作者数目和机械臂相同,n表示机械臂的数目,dsi(t)为从手i在t时刻的扰动项,且满足|dsi(t)|<δsi,τcsi(t)表示t时刻的控制力矩,Fsi(t)表示从手i操作者作用在环境的作用力表示从手i的雅克比矩阵,qmi,和分别表示主手i在关节坐标系下的角度、角速度度,qsi,和分别表示从手i在关节坐标系下的角度、角速度和角加速度。
受到操作环境的变化,从端机械臂的惯性参数及其相应的矩阵Msi、和Gsi(qsi)在实际操作过程中都会存在不确定项,这种不确定项主要会对从端的操作精度产生较大的影响,所以令和其中和分别表示对参数Msi、Csi和Gsi的初始估计值,ΔMsi、ΔCsi和ΔGsi分别表示不确定值,令表示机器人***动力学的不确定项。
2、建立操作对象的动力学模型
3、从手控制器设计
从端的力位混合控制器如下
其中,ei=qmi(t-T)-qsi(t),T表示主从端的通信时延,qmi(t-T)表示从主端经过时延T之后传递到从端的信号,表示矩阵Jsi(qsi)的广义逆矩阵,k1表示一个常数,κ1(t)表示与性能函数相关的时变系数,其具体表达式为
3、主手控制器设计
其中,kmi为一个正数,表示***的控制参数,通过调节参数kmi可以保证***的稳定性,ηmi为***的鲁棒项,用来减弱参数εi对***稳定性的影响,其中ηmi的表达式如下:
ηmi=δmi·sat(εi,μmi)
其中,μmi为一个正数,表示对于εi限制的阈值,δmi为一个比例系数,通常情况下δmi=1。
以步骤3得到的从手控制器和步骤4得到的主手控制器输入步骤1和步骤2的动力学模型中,实现多臂遥操作机器人力/位置混合控制。
Claims (1)
1.一种基于性能函数的多臂遥操作机器人力/位置混合控制方法,其特征在于步骤如下:
步骤1:建立多人遥操作***的操作者和从手机械臂的动力学模型
其中,Mmi,和Gmi(qmi),i=1,2,...,n分别为主手i的惯性矩阵、向心力和科式力和重力参数,n表示操作者的数目,dmi(t)为主手i在t时刻的扰动项,且满足|dmi(t)|<δmi,τmsi(t)表示t时刻的控制力矩,Fhi(t)表示主手i操作者作用在末端点的作用力,表示主手i的雅克比矩阵,Msi,和Gsi(qsi),i=1,2,...,n分别为从手机械臂i的惯性矩阵、向心力和科式力和重力,操作者数目和机械臂相同,n表示机械臂的数目,dsi(t)为从手i在t时刻的扰动项,且满足|dsi(t)|<δsi,τcsi(t)表示t时刻的控制力矩,Fsi(t)表示从手i操作者作用在环境的作用力,表示从手i的雅克比矩阵,qmi,和分别表示主手i在关节坐标系下的角度、角速度和角加速度,qsi,和分别表示从手i在关节坐标系下的角度、角速度和角加速度;
步骤2:建立操作对象的动力学模型
步骤3:设计从手控制器
受到操作环境的变化,从端机械臂的惯性参数及其相应的矩阵Msi、和Gsi(qsi)在实际操作过程中都会存在不确定项,令和其中和分别表示对参数Msi、Csi和Gsi的初始估计值,ΔMsi、ΔCsi和ΔGsi分别表示不确定值,令表示机器人***动力学的不确定项;
从端的力位混合控制器:
其中,ei=qmi(t-T)-qsi(t),T表示主从端的通信时延,qmi(t-T)表示从主端经过时延T之后传递到从端的信号,表示矩阵Jsi(qsi)的广义逆矩阵,k1表示一个常数,κ1(t)表示与性能函数相关的时变系数,其具体表达式为:
其中,μsi为一个正数,表示对于ei限制的阈值,δsi为一个比例系数,通常情况下δsi=1;
步骤4:主手控制器设计
其中,kmi为一个正数,表示***的控制参数,通过调节参数kmi可以保证***的稳定性,ηmi为***的鲁棒项,用来减弱参数εi对***稳定性的影响,其中ηmi的表达式如下:
ηmi=δmi·sat(εi,μmi)
其中,μmi为一个正数,表示对于εi限制的阈值,δmi为一个比例系数,通常情况下δmi=1;
步骤5:以步骤3得到的从手控制器和步骤4得到的主手控制器输入步骤1和步骤2的动力学模型中,实现多臂遥操作机器人力/位置混合控制。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201810820246.1A CN109015634B (zh) | 2018-07-24 | 2018-07-24 | 基于性能函数的多臂遥操作机器人力/位置混合控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201810820246.1A CN109015634B (zh) | 2018-07-24 | 2018-07-24 | 基于性能函数的多臂遥操作机器人力/位置混合控制方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN109015634A CN109015634A (zh) | 2018-12-18 |
CN109015634B true CN109015634B (zh) | 2021-07-06 |
Family
ID=64645690
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201810820246.1A Active CN109015634B (zh) | 2018-07-24 | 2018-07-24 | 基于性能函数的多臂遥操作机器人力/位置混合控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN109015634B (zh) |
Families Citing this family (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN110587569A (zh) * | 2019-09-09 | 2019-12-20 | 西安天圆光电科技有限公司 | 一种双臂机器人协同遥操作控制方法 |
CN110480641B (zh) * | 2019-10-08 | 2021-03-19 | 北京理工大学 | 一种机械臂的递推分布式快速收敛鲁棒控制方法 |
CN110919633A (zh) * | 2019-12-06 | 2020-03-27 | 泉州市微柏工业机器人研究院有限公司 | 一种基于力矩控制的机器人的位置偏移方法 |
CN111329581B (zh) * | 2020-01-23 | 2022-03-15 | 诺创智能医疗科技(杭州)有限公司 | 手术机械臂的力反馈测量方法和手术机械臂 |
CN111604908B (zh) * | 2020-06-04 | 2022-09-02 | 云南电网有限责任公司电力科学研究院 | 一种架空线路检修机器人机械臂的力位混合控制方法 |
CN113910232B (zh) * | 2021-10-27 | 2022-12-20 | 苏州艾利特机器人有限公司 | 一种自适应姿态跟踪方法、装置、存储介质及电子设备 |
Family Cites Families (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP5105450B2 (ja) * | 2010-03-15 | 2012-12-26 | 学校法人立命館 | マスタスレーブシステム及びその制御方法 |
CN106584455B (zh) * | 2016-10-11 | 2019-06-11 | 苏州继企机电科技有限公司 | 一种遥操作机械臂***的时延控制方法 |
CN106647241B (zh) * | 2016-12-05 | 2020-02-04 | 南昌航空大学 | 一种新型的非线性pid控制器 |
CN106938462B (zh) * | 2016-12-07 | 2019-05-31 | 北京邮电大学 | 一种基于自适应pd和模糊逻辑的遥操作双边控制方法 |
CN106945043B (zh) * | 2017-04-18 | 2020-05-08 | 中国科学院重庆绿色智能技术研究院 | 一种主从式遥操作手术机器人多臂协同控制*** |
-
2018
- 2018-07-24 CN CN201810820246.1A patent/CN109015634B/zh active Active
Also Published As
Publication number | Publication date |
---|---|
CN109015634A (zh) | 2018-12-18 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN109015634B (zh) | 基于性能函数的多臂遥操作机器人力/位置混合控制方法 | |
He et al. | Admittance-based controller design for physical human–robot interaction in the constrained task space | |
Chen et al. | RBFNN-based adaptive sliding mode control design for delayed nonlinear multilateral telerobotic system with cooperative manipulation | |
CN109358506B (zh) | 一种基于干扰观测器的自适应模糊遥操作控制方法 | |
CN106945043B (zh) | 一种主从式遥操作手术机器人多臂协同控制*** | |
CN106647260B (zh) | 一种基于相对阻抗的双臂遥操作自适应控制方法 | |
CN110497415B (zh) | 一种基于干扰观测器的多机械臂***的一致控制方法 | |
Zhang et al. | Attitude decoupling control of semifloating space robots using time-delay estimation and supertwisting control | |
Zhou et al. | Torque sensorless force/position decentralized control for constrained reconfigurable manipulator with harmonic drive transmission | |
Lu et al. | High‐gain nonlinear observer‐based impedance control for deformable object cooperative teleoperation with nonlinear contact model | |
CN114179089B (zh) | 一种机械臂的鲁棒区域跟踪控制方法 | |
Miao et al. | Geometric formation tracking of quadrotor UAVs using pose-only measurements | |
Huzaefa et al. | Centralized control architecture for cooperative object transportation using multiple omnidirectional AGVs | |
Zhang et al. | Adaptive learning-based distributed control of cooperative robot arm manipulation for unknown objects | |
Sarrafan et al. | High-gain observer-based neural adaptive feedback linearizing control of a team of wheeled mobile robots | |
Ghavifekr et al. | Multirate adaptive inverse dynamics control of 5 DOF industrial gryphon robot | |
CN109048995B (zh) | 一种三自由度Delta并联机器人的非线性关节摩擦力补偿方法 | |
Jung et al. | Reference compensation technique of neural force tracking impedance control for robot manipulators | |
Irawan et al. | Interaction Motion Control on Tri-finger Pneumatic Grasper using Variable Convergence Rate Prescribed Performance Impedance Control with Pressure-based Force Estimator | |
CN116175585A (zh) | 具有输入饱和与输出约束的多关节机械臂ude控制方法 | |
CN113110070B (zh) | 一种执行器饱和下遥操作***自适应控制方法 | |
CN108406766B (zh) | 一种基于复合积分滑模的多机械臂***同步控制方法 | |
Chen et al. | Attitude tracking control of rigid spacecraft with disturbance compensation | |
Zeng et al. | A generalized multivariable adaptive super-twisting control and observation for amphibious robot | |
CN113927596B (zh) | 一种基于宽度神经学习的时变输出约束机器人遥操作有限时间控制方法 |
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 |