CN108453732B - 控制体系封闭机器人自适应动态力/位置混合控制方法 - Google Patents
控制体系封闭机器人自适应动态力/位置混合控制方法 Download PDFInfo
- Publication number
- CN108453732B CN108453732B CN201810161919.7A CN201810161919A CN108453732B CN 108453732 B CN108453732 B CN 108453732B CN 201810161919 A CN201810161919 A CN 201810161919A CN 108453732 B CN108453732 B CN 108453732B
- Authority
- CN
- China
- Prior art keywords
- robot
- force
- joint
- control method
- matrix
- 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
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
Landscapes
- Engineering & Computer Science (AREA)
- Robotics (AREA)
- Mechanical Engineering (AREA)
- Feedback Control In General (AREA)
- Manipulator (AREA)
Abstract
本发明涉及一种针对控制体系封闭机器人的动态力/位置混合控制方法,是一种适用于存在强非线性和不确定性且无开放力矩接口的机器人系统的非线性力/位置混合控制方法,能够同时适应系统内环控制器参数的不确定性和机器人系统的惯量、质量、质心位置等不确定性,属于机器人控制技术领域。本发明提出的基于动态反馈的非线性控制方法充分考虑机器人的动力学耦合和非线性。所提出的控制方法体现为机械臂关节位置或者速度指令,该指令信息中包含基于力的测量信息和机械臂状态信息的动态补偿,用于实现机器人系统的动态力/位置混合控制。所提出的控制方法把目前已有的基于动态反馈的自由空间控制方法推广至考虑机械臂末端同环境接触的情形。
Description
技术领域
本发明涉及一种针对控制体系封闭机器人的动态力/位置混合控制方法,是一种适用于存在强非线性和不确定性且无开放力矩接口的机器人系统的非线性力/位置混合控制方法,能够同时适应系统内环控制器参数的不确定性和机器人系统的惯量、质量、质心位置等不确定性,属于机器人控制技术领域。
背景技术
力/位置混合控制方法是处理机器人同环境柔顺交互的一种重要手段,提出于上个世纪80年代,主要针对关节力矩开放的机器人系统。但是在工业和工程应用场合,动态力/位置混合控制的实施却受到机器人控制体系封闭的约束,比如控制力矩不开放,只能设计关节位置或者速度指令。在工业和商业场合,大部分公司出产的机器人也都具有类似的特点。那么自然提出一个基本问题:如何在有限的设计自由度(只开放关节位置或者速度指令)下,实现机器人动态力/位置混合控制?
针对此问题的传统做法是施加运动学控制,忽略机器人动力学的影响。这种做法对于大减速比工业机器人有一定的适用性,因为安装有大减速比减速器的工业机器人的动力学耦合大大降低。但是在精度、安全性和合作性要求更多的场合,特别是目前蓬勃发展的协作机器人和轻型机器人,运动学控制所忽略的机器人非线性耦合的影响占有很大的比重,对于系统的稳定性和动态精度都有不可忽视的影响。因此需要一种能够充分考虑机器人系统动力学影响的力/位置混合控制方法,以保证操作的精度、安全性和动态性能。
发明内容
本发明的技术解决问题是:克服现有技术的不足,提出控制体系封闭机器人自适应动态力/位置混合控制方法,该方法针对存在较强非线性和参数不确定性的控制体系封闭机器人,为一种基于动态反馈的自适应力/位置混合控制方法。
本发明的技术解决方案是:
控制体系封闭机器人自适应动态力/位置混合控制方法,包括下列步骤:
(1)建立控制体系封闭机器人的参数化模型
考虑接触柔顺环境的n自由度机器人。用x∈Rn表示机械臂末端位置,q∈Rn表示机械臂关节位置,那么有经典关系式:
x=σ(q) (1)
其中σ:Rn→Rn为非线性函数,Rn表示n维实空间。用J(q)∈Rn×n表示机械臂的雅克比矩阵,那么机械臂末端速度和机械臂关节速度的关系可表述为如下的经典形式:
用δx表示环境轮廓由于同机械臂末端的交互作用而产生的变形量,那么有经典关系式:
H(x)=δx (3)
其中H:Rn→R为非线性函数,那么根据目前已有的结果,机械臂末端与环境轮廓的接触力f可表达为
其中γ=kδx为接触力的幅值大小,k为环境刚度。对于力/位置混合控制,任务空间变量通常定义为
其中ξ(x)为n-1维位置矢量。根据公式(5)和公式(2)、(3)得到:
其中J*(q,x)为雅克比矩阵。
根据已有研究结果,控制体系封闭机器人的动力学模型可表达为:
其中,M(q)∈Rn×n为惯量矩阵,为科氏力和离心力矩阵,B∈Rn×n为对角正定矩阵,g(q)∈Rn为重力力矩,KD为微分增益,KP为比例增益,qc为关节位置指令,为关节速度指令。大部分工业和商业机器人都具有上述动力学特性,只对使用者开放关节位置指令或者速度指令,且使用者一般无法精确获得KD和KP的信息(KD和KP为融合机器人生产商所设计的PD控制增益和关节驱动器特性的等效微分、比例增益,为对角正定矩阵)。为便于后续控制器设计,把上述动力学模型参数化为(类似于控制体系封闭机器人自由空间运动控制的情况):
(2)设计基于动态反馈的自适应控制律:
控制目标为使得机械臂末端对环境施加期望作用力γd,机械臂末端到达期望位置xd。此处考虑调节问题,因此γd和xd均为常值。
定义矢量z∈Rn为
其中α1,α2和α3为正设计常数,Δγ=γ-γd,Δξ(x)=ξ(x)-ξ(xd)。方程(10)给出的滤波形式的动态系统可看作经典的无源滤波器的推广。定义矢量
关节控制律(关节控制律给定关节位置指令或关节速度指令)定义为
其中,t为当前时刻,zI(0)为zI的初值,zI(0)可选为任意常数。
其中Γ为对称正定矩阵,Λ和ΛP为对角正定矩阵。
(4)循环执行步骤(3),当循环次数趋于无穷时,机械臂末端力调节误差Δγ和位置调节误差Δξ(x)趋于零。
本发明与现有技术相比的有益效果是:
(1)本发明针对控制体系封闭机器人的力/位置混合控制问题,在系统存在非线性和不确定性的情况下,通过一种动态反馈方法生成关节位置或者速度指令的方式,对系统的非线性和不确定性予以恰当的补偿,目前的文献中只有关于控制体系封闭机器人自由空间运动的相关内容,但没有针对接触空间运动的相关内容;
(2)本发明同时考虑了机器人底层控制器参数的不确定性和底层驱动模型的不确定性,并设计了相应的参数自适应规律;
(3)本发明提出一种基于动态反馈的力/位置混合控制方法,在机器人系统力矩接口不开放的情况下,对系统的不确定性和非线性进行了有效的补偿,保证了系统的稳定性和收敛性。
(4)本发明提出的基于动态反馈的非线性控制方法充分考虑机器人的动力学耦合和非线性。所提出的控制方法体现为机械臂关节位置或者速度指令,该指令信息中包含基于力的测量信息和机械臂状态信息的动态补偿,用于实现机器人系统的动态力/位置混合控制。所提出的控制方法把目前已有的基于动态反馈的自由空间控制方法推广至考虑机械臂末端同环境接触的情形。
(5)控制体系封闭机器人的自适应动态力/位置混合控制方法,包括下列步骤:(1)建立控制体系封闭机器人的参数化模型;(2)设计基于动态反馈的自适应控制律;(3)根据自适应控制律更新关节位置指令或速度指令和估计参数;(4)循环执行步骤(3)。本发明针对控制体系封闭机器人动态力/位置混合控制问题,在存在不确定性和非线性的情况下,通过基于动态反馈的自适应控制方法设计关节位置或者速度指令以保证实现力和位置的调节目标。
附图说明
图1为本发明控制体系封闭机器人的自适应动态力/位置混合控制方法的流程框图;
图2为本发明仿真例子中两自由度机械臂接触环境的示意图;
图3为本发明仿真例子中力调节误差示意图;
图4为本发明仿真例子中位置调节误差示意图。
具体实施方式
控制体系封闭机器人自适应动态力/位置混合控制方法,包括下列步骤:
(1)建立控制体系封闭机器人的参数化模型
如图2所示,考虑接触柔顺环境的n自由度机器人(n=2)。用x∈Rn表示机械臂末端位置,q∈Rn表示机械臂关节位置,那么有经典关系式:
x=σ(q)(1)
其中σ:Rn→Rn为非线性函数,Rn表示n维实空间。用J(q)∈Rn×n表示机械臂的雅克比矩阵,那么机械臂末端速度和机械臂关节速度的关系可表述为如下的经典形式:
用δx表示环境轮廓由于同机械臂末端的交互作用而产生的变形量,那么有经典关系式:
H(x)=δx(3)
其中H:Rn→R为非线性函数,那么根据目前已有的结果,机械臂末端与环境轮廓的接触力f可表达为
其中γ=kδx为接触力的幅值大小,k为环境刚度。对于力/位置混合控制,任务空间变量通常定义为
其中ξ(x)为n-1维位置矢量。根据公式(5)和公式(2)、(3)得到:
控制体系封闭机器人的动力学模型为:
其中,M(q)∈Rn×n为惯量矩阵,为科氏力和离心力矩阵,B∈Rn×n为对角正定矩阵,g(q)∈Rn为重力力矩,KD为微分增益,KP为比例增益,qc为关节位置指令,为关节速度指令。大部分工业和商业机器人都具有上述动力学特性,只对使用者开放关节位置指令或者速度指令,且使用者一般无法精确获得KD和KP的信息(KD和KP为融合机器人生产商所设计的PD控制增益和关节驱动器特性的等效微分、比例增益,为对角正定矩阵)。为便于后续控制器设计,把上述动力学模型参数化为如下形式:
(2)设计基于动态反馈的自适应控制律:
控制目标为使得机械臂末端对环境施加期望作用力γd,机械臂末端到达期望位置xd。此处考虑调节问题,因此γd和xd均为常值。
定义矢量z∈Rn为
其中α1,α2和α3为正设计常数,Δγ=γ-γd,Δξ(x)=ξ(x)-ξ(xd)。定义矢量
关节控制律(关节控制律给定关节位置指令或关节速度指令)定义为
其中,t为当前时刻,zI(0)为zI的初值,zI(0)可选为任意常数。
其中Γ为对称正定矩阵,Λ和ΛP为对角正定矩阵。
(4)循环执行步骤(3),当循环次数趋于无穷时,机械臂末端力调节误差Δγ和位置调节误差Δξ(x)趋于零。
本发明以两自由度机械臂接触环境时的力/位置控制为例进行阐述。在系统控制体系封闭的情况下,所提出的基于动态反馈的自适应力/位置混合控制方法能够实现对系统非线性和不确定性的恰当补偿,从而保证了机械臂末端力和位置误差的收敛性。
如图1所示,本发明提供了一种自适应动态力/位置混合控制方法,包括下列步骤:
(1)建立控制体系封闭机器人的参数化模型;
柔性环境表面给定为其中a=2,b=3,c=0.5772,x=[x1,x2]T,x1和x2为机械臂末端位置的坐标分量。两自由度机械臂的物理参数给定为m1=2.7,IC,1=1.1902,l1=2.30,lC,1=1.15,m2=1.5,IC,2=0.3200,l2=1.60,lC,2=0.80,其中mi,IC,i,li,lC,i分别表示第i个臂杆的质量、绕质心的转动惯量、臂杆长度、质心到关节转轴的距离,i=1,2。根据《Robot modeling and control》(M.W.Spong等著),可以得到机械臂的动力学模型(未考虑同环境接触时):
其中,q=[q1,q2]T为关节位置矢量,τ=[τ1,τ2]T为关节控制力矩矢量,参数矢量
内环等效PD控制器参数给定为KD=diag[1200,600],KP=diag[1800,900]。这样得到考虑机器人系统同环境接触时的参数化模型
(2)设计基于动态反馈的自适应力/位置混合控制律
定义一个矢量z∈R2为:
其中α1,α2和α3为正设计常数,Δγ=γ-γd,Δξ(x)=ξ(x)-ξ(xd)。定义矢量
关节控制律定义为
其中,t为当前时刻,zI(0)为zI的初值,zI(0)可选为任意常数。
其中Γ为对称正定矩阵,Λ和ΛP为对角正定矩阵。
在仿真中,设计参数设定为:α1=0.08,α2=8,α3=36,Γ=100I5,Λ=0.02I2,ΛP=1000I2,控制目标给定为:γd=5,ξ(xd)=2.0588,机械臂初始构型q(0)=[π/3,-2π/3]T,初始关节速度对应的x*(0)=[6.1698×10-5,1.9588]T,γ(0)=0.3702。参数估计初值选择为环境刚度设定为k=6000。内环PD控制的采样周期为0.5ms;外环控制周期较慢,设定为10ms。
采用本发明给出的自适应控制方法的仿真结果如图3、图4。
图3给出的是力的误差曲线,图4给出的是位置的误差曲线。
根据图3和图4可以看出:本发明给出的自适应力/位置混合控制方法可有效保证力和位置调节误差的渐近收敛性。
本发明说明书中未作详细描述的内容属本领域专业技术人员的公知技术。
Claims (3)
1.控制体系封闭机器人自适应动态力/位置混合控制方法,其特征在于包括下列步骤:
(1)建立控制体系封闭机器人的参数化模型;
所述的参数化模型为
其中,q∈Rn表示机械臂关节位置,M(q)∈Rn×n为惯量矩阵,为科氏力和离心力矩阵,B∈Rn×n为对角正定矩阵,g(q)∈Rn为重力力矩,qc为关节位置指令,为关节速度指令;w∈Rn为n维常值矢量,wP∈Rn为n维常值矢量,KD为微分增益,KP为比例增益;J(q)∈Rn×n表示机械臂的雅克比矩阵,f为机械臂末端与环境轮廓的接触力;n为控制体系封闭机器人的自由度;
(2)设计基于动态反馈的自适应控制律:
所述的自适应控制律包括关节控制律和参数自适应律;
所述的关节控制律为
其中α1,α2和α3为正设计常数,Δγ=γ-γd,γ=kδx为接触力的幅值大小,Δξ(x)=ξ(x)-ξ(xd),zI定义为
其中,t为当前时刻,zI(0)为zI的初值,zI(0)可选为任意常数;
γd为机械臂末端对环境的期望作用力,xd为机械臂末端期望位置,γd和xd均为常值;ξ(x)为n-1维位置矢量,ξ(x)与δx垂直,δx表示环境轮廓由于同机械臂末端的交互作用而产生的变形量;
所述的参数自适应律为
2.根据权利要求1所述的控制体系封闭机器人自适应动态力/位置混合控制方法,其特征在于:循环执行步骤(3),当循环次数趋于无穷时,机械臂末端力调节误差Δγ和位置调节误差Δξ(x)趋于零。
3.根据权利要求1所述的控制体系封闭机器人自适应动态力/位置混合控制方法,其特征在于:所述的步骤(1)中,建立控制体系封闭机器人的参数化模型的方法为:
用x∈Rn表示机械臂末端位置,q∈Rn表示机械臂关节位置,则:
x=σ(q) (1)
其中σ:Rn→Rn为非线性函数,Rn表示n维实空间,用J(q)∈Rn×n表示机械臂的雅克比矩阵,那么机械臂末端速度和机械臂关节速度的关系表述为:
用δx表示环境轮廓由于同机械臂末端的交互作用而产生的变形量,那么有:
H(x)=δx (3)
其中H:Rn→R为非线性函数,机械臂末端与环境轮廓的接触力f为:
其中γ=kδx为接触力的幅值大小,k为环境刚度;对于力/位置混合控制,任务空间变量定义为:
其中ξ(x)为n-1维位置矢量,根据公式(5)和公式(2)、(3)得到:
J*(q,x)为雅克比矩阵;
控制体系封闭机器人的动力学模型为:
上述动力学模型参数化为如下形式:
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201810161919.7A CN108453732B (zh) | 2018-02-27 | 2018-02-27 | 控制体系封闭机器人自适应动态力/位置混合控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201810161919.7A CN108453732B (zh) | 2018-02-27 | 2018-02-27 | 控制体系封闭机器人自适应动态力/位置混合控制方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN108453732A CN108453732A (zh) | 2018-08-28 |
CN108453732B true CN108453732B (zh) | 2020-07-14 |
Family
ID=63217629
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201810161919.7A Active CN108453732B (zh) | 2018-02-27 | 2018-02-27 | 控制体系封闭机器人自适应动态力/位置混合控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN108453732B (zh) |
Families Citing this family (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN111376263B (zh) * | 2018-12-29 | 2022-08-02 | 沈阳新松机器人自动化股份有限公司 | 一种复合机器人人机协作系统及其交叉耦合力控制方法 |
CN110497423B (zh) * | 2019-08-22 | 2022-08-16 | 泉州装备制造研究所 | 一种机械手自适应加工方法 |
CN111098309A (zh) * | 2020-01-06 | 2020-05-05 | 江南大学 | 一种机械臂混杂控制方法、装置及系统 |
CN112650268A (zh) * | 2020-12-25 | 2021-04-13 | 深圳市优必选科技股份有限公司 | 机器人的运动控制方法、装置、机器人及存储介质 |
CN114102599B (zh) * | 2021-12-02 | 2023-10-20 | 中国科学技术大学 | 基于柔性机械臂的人机交互自适应控制方法和系统 |
CN114434429B (zh) * | 2022-03-18 | 2023-09-08 | 南京航空航天大学 | 一种工业机器人动态精度设计方法和系统 |
CN115257995A (zh) * | 2022-05-19 | 2022-11-01 | 伍福人工智能(河南)有限公司 | 机器人的控制方法、装置、终端设备以及存储介质 |
CN114888813B (zh) * | 2022-06-21 | 2023-08-04 | 广州大学 | 机械臂位置力混合控制方法及装置 |
Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPS61134803A (ja) * | 1984-12-04 | 1986-06-21 | Daido Steel Co Ltd | 位置決め用駆動装置の離散時間モデル規範形適応制御方法 |
CN103213129A (zh) * | 2013-04-17 | 2013-07-24 | 北京空间飞行器总体设计部 | 一种空间机械臂位置力混合控制方法 |
CN103279029A (zh) * | 2013-05-31 | 2013-09-04 | 北京航空航天大学 | 多机器人手臂系统的自适应协调控制方法 |
CN103433924A (zh) * | 2013-07-26 | 2013-12-11 | 无锡信捷电气股份有限公司 | 串联机器人高精度位置控制方法 |
CN103624784A (zh) * | 2013-11-06 | 2014-03-12 | 北京控制工程研究所 | 一种空间多臂复杂连接联合体自适应控制方法 |
CN106938462A (zh) * | 2016-12-07 | 2017-07-11 | 北京邮电大学 | 一种基于自适应pd和模糊逻辑的遥操作双边控制方法 |
-
2018
- 2018-02-27 CN CN201810161919.7A patent/CN108453732B/zh active Active
Patent Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPS61134803A (ja) * | 1984-12-04 | 1986-06-21 | Daido Steel Co Ltd | 位置決め用駆動装置の離散時間モデル規範形適応制御方法 |
CN103213129A (zh) * | 2013-04-17 | 2013-07-24 | 北京空间飞行器总体设计部 | 一种空间机械臂位置力混合控制方法 |
CN103279029A (zh) * | 2013-05-31 | 2013-09-04 | 北京航空航天大学 | 多机器人手臂系统的自适应协调控制方法 |
CN103433924A (zh) * | 2013-07-26 | 2013-12-11 | 无锡信捷电气股份有限公司 | 串联机器人高精度位置控制方法 |
CN103624784A (zh) * | 2013-11-06 | 2014-03-12 | 北京控制工程研究所 | 一种空间多臂复杂连接联合体自适应控制方法 |
CN106938462A (zh) * | 2016-12-07 | 2017-07-11 | 北京邮电大学 | 一种基于自适应pd和模糊逻辑的遥操作双边控制方法 |
Non-Patent Citations (1)
Title |
---|
受动态约束机械臂力/位置控制方法研究;黄绍辉;《中国优秀硕士学位论文全文数据库 信息科技辑》;20071015;140-173 * |
Also Published As
Publication number | Publication date |
---|---|
CN108453732A (zh) | 2018-08-28 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN108453732B (zh) | 控制体系封闭机器人自适应动态力/位置混合控制方法 | |
CN108319144B (zh) | 一种机器人轨迹跟踪控制方法及系统 | |
CN111941432B (zh) | 一种高性能机械臂人工智能输出反馈控制方法 | |
CN108875253B (zh) | 基于干扰观测器的欠驱动吊车系统的终端滑模消摆控制方法及系统 | |
CN107450326B (zh) | 反步有限时间双边遥操作控制方法及计算机可读存储介质 | |
CN110673472B (zh) | 基于神经网络补偿死区反演误差的自适应鲁棒控制方法 | |
Korayem et al. | Path planning algorithm in wheeled mobile manipulators based on motion of arms | |
Chu et al. | Adaptive trajectory tracking control for remotely operated vehicles considering thruster dynamics and saturation constraints | |
CN111702767A (zh) | 一种基于反演模糊自适应的机械手阻抗控制方法 | |
CN115990888B (zh) | 一种具有死区和时变约束功能的机械臂控制方法 | |
CN110842913A (zh) | 一种单关节机械臂的自适应滑模迭代学习控制方法 | |
Jiang et al. | Multi-hierarchy interaction control of a redundant robot using impedance learning | |
Ansari et al. | Quadrotor motion control using adaptive generalized dynamic inversion | |
CN115480583A (zh) | 飞行作业机器人的视觉伺服跟踪与阻抗控制方法 | |
CN113219825B (zh) | 一种四足机器人单腿轨迹跟踪控制方法及系统 | |
CN112643673B (zh) | 基于非线性干扰观测器的移动机械臂鲁棒控制方法及系统 | |
Soltanpour et al. | Sliding mode robust control of robot manipulators in the task space by support of feedback linearization and backstepping control | |
CN109048995B (zh) | 一种三自由度Delta并联机器人的非线性关节摩擦力补偿方法 | |
CN116068893A (zh) | 一种机械臂自适应分数阶滑模控制方法、设备及介质 | |
CN112147894B (zh) | 基于运动学和动力学模型的轮式移动机器人主动控制方法 | |
US20220308530A1 (en) | System for Performing a Task According to a Reference Trajectory | |
CN113296398A (zh) | 一种柔性单链机械臂基于事件触发的命令滤波控制方法 | |
CN113359481B (zh) | 基于滑模控制的倒立摆系统自适应鲁棒h∞控制方法 | |
CN113110532B (zh) | 基于辅助动态系统的可底栖式auv自适应终端滑模轨迹跟踪控制方法 | |
Yan et al. | Modeling, analysis, and adaptive neural modified-backstepping control of an uncertain horizontal pendubot with double flexible joints |
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 |