CN114516054A - 一种机械臂时延估计控制方法 - Google Patents
一种机械臂时延估计控制方法 Download PDFInfo
- Publication number
- CN114516054A CN114516054A CN202210294070.7A CN202210294070A CN114516054A CN 114516054 A CN114516054 A CN 114516054A CN 202210294070 A CN202210294070 A CN 202210294070A CN 114516054 A CN114516054 A CN 114516054A
- Authority
- CN
- China
- Prior art keywords
- gain
- time
- control
- time delay
- 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.)
- Granted
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/1679—Programme controls characterised by the tasks executed
Landscapes
- Engineering & Computer Science (AREA)
- Robotics (AREA)
- Mechanical Engineering (AREA)
- Feedback Control In General (AREA)
Abstract
本发明公开一种机械臂时延估计控制方法。该方法包含:时延估计、分数阶非奇异终端滑模动力学以及非线性自适应增益。时延估计用简洁的形式来估计集总***的动力学,分数阶非奇异终端滑模用来保证高的控制性能,非线性自适应增益具有新的非线性结构和简单有效的更新算法,在控制性能好时有效抑制噪声影响,在控制性能差时确保高的自适应性能。本方法提出的时延控制方法无模型、精度高、鲁棒性好,从而进一步提升了绳驱动机械臂的控制效果和作业性能。
Description
技术领域
本发明属于机器人***控制技术领域,特别是对一类机械臂的轨迹跟踪控制方法。
背景技术
绳驱动机械臂以其运动惯性小、能耗低、灵活性高、交互安全性好、载荷重量比大等特点收到越来越多的关注。但绳驱动技术的应用也给高性能控制带来挑战。因此,如何在复杂的不确定性和时变干扰情况下精确控制机械臂的问题,受到许多学者的关注。在过去的几年里,报道了一些柔性机械臂的控制方法[W.Shang,B.Zhang,B.Zhang,F.Zhang,andS.Cong,“Synchronization control in the cable space for cable-driven parallelrobots,”IEEE Trans.Ind.Electron.,vol.66,no.6,pp.4544-4554,Jun.2019.]。然而,其通常需要复杂的估计算法,而不适用于实际应用,特别是在时变不确定性和干扰下。在实际应用中,控制方案的关键要求是简单、有效和鲁棒性。
时延控制是一种简单有效的方法,是解决上述问题的有利工具。通常时延控制分为两个部分:时延估计和期望动力学。前者用于估计集总***动力学,并保证无模型方案;后者保证一定的控制性能。时延控制由于无模型这一优势,被广泛应用于许多实际***中,如双足机器人、外骨骼机器人等。但时延估计的使用也会产生误差,即时延估计误差。因此,动力学部分通常采用鲁棒控制策略来抑制潜在的时延估计误差,如滑模控制及其变分[S.Lee,and P.H.Chang,“Control of a heavy-duty robotic excavator using timedelay control with integral sliding surface,”Control Eng.Pract.,vol.10,no.7,pp.697-711,2002.]、自适应控制[M.Ghafarian,B.Shirinzadeh,A.Al-Jodah andT.K.Das,“Adaptive fuzzy sliding mode control for high-precision motiontracking of a multi-DOF micro/nano manipulator,”IEEE Robot.Autom.Lett.,vol.5,no.3,pp.4313-4320,Jul.2017.]等。虽然上述时延控制方案取得了显著的成果,但大多数仍受控制增益恒定的限制,即可能不适用于时变不确定性和扰动的实际情况。
Y.Wang等人提出了一种利用非线性自适应调节增益的时延控制方案[Y.Wang,L.Liu,D.Wang,F.Ju,and B.Chen,“Time-delay control using a novel nonlinearadaptive law for accurate trajectory tracking of cable-driven robots,”IEEETrans.Ind.Informat.,vol.16,no.8,pp.5234-5243,2020.],通过建立新的缓冲区,上述自适应律能够在有效抑制噪声影响的同时提高自适应性能。该方法还可以在以下两个方面进行改进:1)对非线性自适应律进行改进,进一步提高自适应性能和抑制噪声效应。2)考虑到自适应律的复杂形式,应有效简化自适应律。其设计的自适应律使用了七个额外参数,这显然不利于实际应用。
发明内容
本发明的目的是提供一种更加有效的自适应控制算法,目的为提升机械臂的控制效果并满足工程实际应用需求。
为解决上述问题,本发明提出了一种新的非线性结构和简单有效的自适应增益更新算法,提出一种基于非线性自适应增益的时延控制方案,保证控制精度和鲁棒性,并利用李雅普诺夫方法,考虑自适应增益和分数阶非奇异终端滑模动力学,证明了算法的稳定性。
本发明公开一种机械臂时延估计控制方法,用以控制n自由度绳驱动串联机械臂,其中n为正整数,包含以下步骤:
(1)建立n自由度绳驱动机械臂动力学方程:
式中,θt为机器人电机的位置向量,qt为机器人关节的位置向量,t为时刻,为θt的一阶导数,为θt的二阶导数,为qt的一阶导数,为qt的二阶导数,D表示电机的阻尼矩阵,J表示电机的惯量矩阵,τlink,t是连杆力矩,τt是电机力矩,M(qt)表示惯性矩阵,表示科里奥利/离心矩阵,G(qt)是重力矢量,是摩擦矢量,τd,t用于描述集总不确定性,Kp表示关节刚度的矩阵,Kd表示关节阻尼的矩阵;
(2)将步骤(1)中给出的绳驱动机械臂动力学方程改写成如下形式:
(4)基于时延估计,得到经典时延控制方法如下:
(5)将步骤(4)代入步骤(2)中,获得如下误差动力学:
(6)在δt有界的情况下,通过选择合适的kp和kd,保持误差动力学稳定,同时为保证δt的有界性,满足下列条件,其中I为单位矩阵:
(7)采用如下的滑模面:
式中,st为滑模面,为趋近律,Dβ[●],-1<β<1为分数阶算子,λ1,λ2,α1,α2,β1,β2,k1,k2,μ都为常数增益,其中α1,α2,β1,β2,μ为正增益,且满足0<α1,0<α2,0<β1<1,0<β2<1,0<μ<1,
(8)通过步骤(7),设计控制器为:
(9)最终,控制器设计为:
本发明的优势:本发明的控制算法采用了一种新的非线性结构和简单有效的自适应增益更新算法,新的自适应更新算法只需要3个参数。所提出的时延控制方案是无模型的、高精度和强鲁棒性的。
附图说明
图1为本发明实施例中采用的绳驱动机械臂Polaris-I;
图2为具体实施本发明所述控制器与其他控制器的控制性能对比图;控制性能比较:本发明所提控制器为黑色实线;Wang的控制器1、Wang的控制器2、Baek的控制器、Jin的控制器为其他灰色实线或虚线;(a)和(b)为跟踪性能,(c)和(d)为控制误差,(e)和(f)为放大的峰值相位控制误差,(g)和(h)为控制力矩;
具体实施方式
下面结合附图进一步说明本发明,以下实例仅用于描述本发明而不用于限制本发明的使用范围,各领域工程技术人员对本发明的各种等价变换均包含在本发明所要求的权利范围内。具体实施步骤如下:
本发明公开一种机械臂时延估计控制方法,用以控制n自由度绳驱动串联机械臂,其中n为正整数,该控制方法包含以下步骤:
(1)建立n自由度绳驱动机械臂动力学方程:
式中,θt为机器人电机的位置向量,如图1中的θ1,θ2。qt为机器人关节的位置向量,如图1中的q1,q2,t为时刻,为θt的一阶导数,为θt的二阶导数,为qt的一阶导数,为qt的二阶导数,D表示电机的阻尼矩阵,J表示电机的惯量矩阵,τlink,t是连杆力矩,τt是电机力矩,M(qt)表示惯性矩阵,表示科里奥利/离心矩阵,G(qt)是重力矢量,是摩擦矢量,τd,t用于描述集总不确定性,Kp表示关节刚度的矩阵,Kd表示关节阻尼的矩阵;
(2)将步骤(1)中给出的绳驱动机械臂动力学方程改写成如下形式:
(4)基于时延估计,得到经典时延控制方法如下:
(5)将步骤(4)代入步骤(2)中,获得如下误差动力学:
(6)在δt有界的情况下,通过选择合适的kp和kd,保持误差动力学稳定,同时为保证δt的有界性,满足下列条件,其中I为单位矩阵:
(7)采用如下的滑模面:
式中,st为滑模面,为趋近律。Dβ[●],-1<β<1为分数阶算子,λ1,2,λ1,λ2,α1,α2,β1,β2,k1,k2,μ都为常数增益,其中α1,α2,β1,β2,μ为正增益,且满足0<α1,0<α2,0<β1<1,0<β2<1,0<μ<1,
(8)通过步骤(7),设计控制器为:
(9)最终,控制器设计为:
对所发明的控制器与自适应算法进行稳定性分析。
设李亚普洛夫方程如下:
结合步骤(11)中的控制器对公式(1)进行微分,可以得到:
然后我们将步骤(9)~(11)中的公式带入到公式(2),得到:
通过比较公式(5)和公式(6),可以看到后者的约束性更强。此外,对于公式(5)和公式(6),Vt在|si,t|=0的情况下似乎是发散的,但是在上述两种情况下,滑模面si,t已经被限制为|si,t|<Ωi,这表示***将保持稳定。当***发散到|si,t|≥Ωi时,应当考虑的情况。因此对公式(5)做如下分析:
为验证所发明控制方法的有效性,本实施例中试验了包括本发明提出的时延控制方法以及其他4种现有技术中存在的时延控制方法。具体的,包括本发明所提出的步骤(11)中的控制器,其他四种控制器分别是:Wang提出的控制器1[Y.Wang,L.Liu,D.Wang,F.Ju,and B.Chen,“Time-delay control using a novel nonlinear adaptive law foraccurate trajectory tracking of cable-driven robots,”IEEETrans.Ind.Informat.,vol.16,no.8,pp.5234-5243,2020.]和控制器2[Y.Wang,F.Yan,J.Chen,F.Ju,and B.Chen,“A new adaptive time-delay control scheme for cable-driven manipulators,”IEEE Trans.Ind.Informat,vol.15,no.6,pp.3469-3481,Jun.2019.],Baek设计的控制器[J.Baek,S.Cho,and S.Han,“Practical time-delaycontrol with adaptive gains for trajectory tracking of robot manipulators,”IEEE Trans.Ind.Electron.,vol.65,no.7,pp.5682-5692,Jul.2018.],以及Jin设计的控制器[M.Jin,J.Lee,and N.G.Tsagarakis,“Model-free robust adaptive control ofhumanoid robots with flexible joints,”IEEE Trans.Ind.Electron.,vol.64,no.2,pp.1706–1715,Feb.2017.]。
采用的实验平台为图1所示的Polaris-I,由ECMA-CA0604SS电机驱动,驱动器为ASD-A2-042-L,关节位置测量采用分辨率为0.045°的传感器E6B2-CWZ1X 2000P/R,Matlab/xPC由PCI-6229板卡搭建,执行周期为1ms。
(1)本发明所提控制器参数设置为:
λ1,2=diag(0.8,0.8),α1,2=diag(0.9,0.9),β1=10-2×(1,1),β2=(0.99,0.99),k1=diag(1,1),k2=diag(2,2),μ=0.8,Ω=10-3×(8,8),Δ=(3,6),k3=102×diag(4,4),k4=104×diag(1.2,1.2),σ=1.8,Δt=2ms.
(2)Wang所提控制器1的参数设置为:
η1=(2,2),η2=10-2×(2,2),Ω=10-2×(1,1),k5=diag(3,3),k6=diag(5,5),k7=diag(2,2),γ=(1.8,1.8)
其余参数与本发明所提控制器参数设置一致。
(3)Wang所提控制器2的参数设置为:
(4)Baek所提控制器参数设置为:
k8=diag(0.13,0.13)。其余参数与本发明所提控制器参数一致。
(5)Jin所提控制器参数设置为:
α3=1-2×(3,5),σ1,=(1.14,1.15),σ2,=(0.8,0.8),ω,=(0.26,0.4),
对比结果如图2和图3所示,为了使比较更加清晰准确,本发明计算了均方根误差(RMSE),最大绝对误差(MAE)和平均绝对误差(AAE),结果如下表1所示。得益于时延估计和FONTSM动力学以及新设计的自适应增益,本发明所提控制器在五种时延控制方法中效果最好。
表1:五种控制器的控制表现
本发明提出的时延控制方案应用时延估计建立了一个无模型结构,确保了实际应用的简单性。然后利用了分数阶非奇异终端滑模动力学,以保证在复杂时变不确定性和扰动下的高控制性能。再基于一种简单有效的更新算法,设计了新的非线性自适应增益来提高性能。通过引入一种新的非线性结构,自适应增益保证了比Y.Wang等人提出的具有更好的综合性能。本发明提出的综合更新算法只需要三个参数。
Claims (1)
1.一种机械臂时延估计控制方法,用以控制n自由度绳驱动串联机械臂,其中n为正整数,其特征在于,包含以下步骤:
(1)建立n自由度绳驱动机械臂动力学方程:
式中,θt为机器人电机的位置向量,qt为机器人关节的位置向量,t为时刻,为θt的一阶导数,为θt的二阶导数,为qt的一阶导数,为qt的二阶导数,D表示电机的阻尼矩阵,J表示电机的惯量矩阵,τlink,t是连杆力矩,τt是电机力矩,M(qt)表示惯性矩阵,表示科里奥利/离心矩阵,G(qt)是重力矢量,是摩擦矢量,τd,t用于描述集总不确定性,Kp表示关节刚度的矩阵,Kd表示关节阻尼的矩阵;
(2)将步骤(1)中给出的绳驱动机械臂动力学方程改写成如下形式:
(4)基于时延估计,得到经典时延控制方法如下:
(5)将步骤(4)代入步骤(2)中,获得如下误差动力学:
(6)在δt有界的情况下,通过选择合适的kp和kd,保持误差动力学稳定,同时为保证δt的有界性,满足下列条件,其中I为单位矩阵:
(7)采用如下的滑模面:
式中,st为滑模面,为趋近律,Dβ[·],-1<β<1为分数阶算子,λ1,λ2,α1,α2,β1,β2,k1,k2,μ都为常数增益,其中α1,α2,β1,β2,μ为正增益,且满足0<α1,0<α2,0<β1<1,0<β2<1,0<μ<1,
(8)通过步骤(7),设计控制器为:
(9)最终,控制器设计为:
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202210294070.7A CN114516054B (zh) | 2022-03-24 | 2022-03-24 | 一种机械臂时延估计控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202210294070.7A CN114516054B (zh) | 2022-03-24 | 2022-03-24 | 一种机械臂时延估计控制方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN114516054A true CN114516054A (zh) | 2022-05-20 |
CN114516054B CN114516054B (zh) | 2023-04-28 |
Family
ID=81600597
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202210294070.7A Active CN114516054B (zh) | 2022-03-24 | 2022-03-24 | 一种机械臂时延估计控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN114516054B (zh) |
Citations (9)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101448183A (zh) * | 2008-12-25 | 2009-06-03 | 北京邮电大学 | 一种用于变长光分组的自适应弹性环光缓存器 |
CN106154835A (zh) * | 2016-08-23 | 2016-11-23 | 南京航空航天大学 | 一种基于时延估计的水下运载器终端滑模控制方法 |
CN108227490A (zh) * | 2017-12-27 | 2018-06-29 | 江苏大学 | 一种新型混联式汽车电泳涂装输送机构的无模型自适应滑模控制方法 |
CN109927032A (zh) * | 2019-03-28 | 2019-06-25 | 东南大学 | 一种基于高阶滑模观测器的机械臂轨迹跟踪控制方法 |
CN110053044A (zh) * | 2019-03-19 | 2019-07-26 | 江苏大学 | 一种并联机器人串类水果夹取无模型自适应光滑滑模阻抗控制方法 |
CN110154028A (zh) * | 2019-05-29 | 2019-08-23 | 天津大学 | 机械臂无模型自适应积分终端滑模控制方法 |
CN110181510A (zh) * | 2019-05-21 | 2019-08-30 | 南京航空航天大学 | 一种基于时延估计与模糊逻辑的机械臂轨迹跟踪控制方法 |
CN110262255A (zh) * | 2019-07-16 | 2019-09-20 | 东南大学 | 一种基于自适应终端滑模控制器的机械臂轨迹跟踪控制方法 |
CN111168682A (zh) * | 2020-01-17 | 2020-05-19 | 江苏大学 | 输送用并联机器人结合鲁棒精确微分器有限时间收敛滑模控制方法 |
-
2022
- 2022-03-24 CN CN202210294070.7A patent/CN114516054B/zh active Active
Patent Citations (9)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101448183A (zh) * | 2008-12-25 | 2009-06-03 | 北京邮电大学 | 一种用于变长光分组的自适应弹性环光缓存器 |
CN106154835A (zh) * | 2016-08-23 | 2016-11-23 | 南京航空航天大学 | 一种基于时延估计的水下运载器终端滑模控制方法 |
CN108227490A (zh) * | 2017-12-27 | 2018-06-29 | 江苏大学 | 一种新型混联式汽车电泳涂装输送机构的无模型自适应滑模控制方法 |
CN110053044A (zh) * | 2019-03-19 | 2019-07-26 | 江苏大学 | 一种并联机器人串类水果夹取无模型自适应光滑滑模阻抗控制方法 |
CN109927032A (zh) * | 2019-03-28 | 2019-06-25 | 东南大学 | 一种基于高阶滑模观测器的机械臂轨迹跟踪控制方法 |
CN110181510A (zh) * | 2019-05-21 | 2019-08-30 | 南京航空航天大学 | 一种基于时延估计与模糊逻辑的机械臂轨迹跟踪控制方法 |
CN110154028A (zh) * | 2019-05-29 | 2019-08-23 | 天津大学 | 机械臂无模型自适应积分终端滑模控制方法 |
CN110262255A (zh) * | 2019-07-16 | 2019-09-20 | 东南大学 | 一种基于自适应终端滑模控制器的机械臂轨迹跟踪控制方法 |
CN111168682A (zh) * | 2020-01-17 | 2020-05-19 | 江苏大学 | 输送用并联机器人结合鲁棒精确微分器有限时间收敛滑模控制方法 |
Non-Patent Citations (1)
Title |
---|
Y. WANG, L. LIU, D. WANG, F. JU AND B. CHEN: "Time-Delay Control Using a Novel Nonlinear Adaptive Law for Accurate Trajectory Tracking of Cable-Driven Robots", 《IEEE TRANSACTIONS ON INDUSTRIAL INFORMATICS》 * |
Also Published As
Publication number | Publication date |
---|---|
CN114516054B (zh) | 2023-04-28 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN111152225A (zh) | 存在输入饱和的不确定机械臂固定时间轨迹跟踪控制方法 | |
CN109189087B (zh) | 一种垂直起降重复使用运载器的自适应容错控制方法 | |
CN114536334B (zh) | 一种柔性机械臂***高阶滑模抗干扰控制方法 | |
CN110450156B (zh) | 多自由度机械臂***自适应模糊控制器的优化设计方法 | |
CN107121932B (zh) | 电机伺服***误差符号积分鲁棒自适应控制方法 | |
CN110340898B (zh) | 一种自由漂浮空间机械臂自适应容错控制方法 | |
CN110181510B (zh) | 一种基于时延估计与模糊逻辑的机械臂轨迹跟踪控制方法 | |
CN110977988A (zh) | 基于有限时间命令滤波的多关节机械臂阻抗控制方法 | |
CN109828468B (zh) | 一种针对磁滞非线性机器人***的控制方法 | |
CN111831011A (zh) | 一种水下机器人平面轨迹跟踪控制的方法 | |
CN113467501A (zh) | 作业飞行机器人动态滑翔抓取与力位混合控制方法 | |
CN115256401A (zh) | 一种基于强化学习的空间机械臂轴孔装配变阻抗控制方法 | |
Zhu et al. | Research and improvement on active compliance control of hydraulic quadruped robot | |
CN115609580A (zh) | 一种空间机械臂柔性振动抑制方法 | |
CN116382076A (zh) | 一种针对受扰轮式移动机器人的双闭环有限时间控制方法 | |
CN114179089A (zh) | 一种机械臂的鲁棒区域跟踪控制方法 | |
CN112783099B (zh) | 分数阶复合控制方法和永磁同步电动机速度伺服*** | |
CN114516054A (zh) | 一种机械臂时延估计控制方法 | |
CN112859618A (zh) | 一种多自由度磁悬浮平面电机自适应学习滑模控制方法 | |
CN116560375A (zh) | 基于神经网络观测器的轮式移动机器人轨迹跟踪控制方法 | |
CN108267970B (zh) | 基于Smith模型和单神经元PID的时滞转子主动平衡控制***及其方法 | |
WO2023165174A1 (zh) | 构建机器人的控制器的方法、机器人的运动控制方法、装置以及机器人 | |
CN112147894B (zh) | 基于运动学和动力学模型的轮式移动机器人主动控制方法 | |
CN112859594B (zh) | 一种用于永磁球形电机轨迹跟踪的终端滑模控制方法 | |
CN114347031A (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 |