CN115847404B - 一种基于复合学习的受限机械臂有限时间控制方法 - Google Patents
一种基于复合学习的受限机械臂有限时间控制方法 Download PDFInfo
- Publication number
- CN115847404B CN115847404B CN202211513838.1A CN202211513838A CN115847404B CN 115847404 B CN115847404 B CN 115847404B CN 202211513838 A CN202211513838 A CN 202211513838A CN 115847404 B CN115847404 B CN 115847404B
- Authority
- CN
- China
- Prior art keywords
- mechanical arm
- time
- matrix
- limited
- control
- 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 38
- 150000001875 compounds Chemical class 0.000 title claims abstract description 14
- 230000004888 barrier function Effects 0.000 claims abstract description 22
- 239000002131 composite material Substances 0.000 claims abstract description 20
- 239000011159 matrix material Substances 0.000 claims description 61
- 230000005284 excitation Effects 0.000 claims description 44
- 239000013598 vector Substances 0.000 claims description 26
- 230000006870 function Effects 0.000 claims description 13
- 230000003044 adaptive effect Effects 0.000 claims description 8
- 230000005484 gravity Effects 0.000 claims description 6
- 230000001133 acceleration Effects 0.000 claims description 5
- 238000004590 computer program Methods 0.000 claims description 5
- 238000001914 filtration Methods 0.000 claims description 5
- 230000015654 memory Effects 0.000 claims description 5
- 238000013461 design Methods 0.000 abstract description 3
- 230000008569 process Effects 0.000 abstract description 2
- 238000010586 diagram Methods 0.000 description 12
- 230000000694 effects Effects 0.000 description 11
- 238000002474 experimental method Methods 0.000 description 4
- 238000004458 analytical method Methods 0.000 description 3
- 101100001674 Emericella variicolor andI gene Proteins 0.000 description 2
- 230000009471 action Effects 0.000 description 2
- 230000008859 change Effects 0.000 description 2
- 230000007547 defect Effects 0.000 description 2
- 230000001360 synchronised effect Effects 0.000 description 2
- 102000002274 Matrix Metalloproteinases Human genes 0.000 description 1
- 108010000684 Matrix Metalloproteinases Proteins 0.000 description 1
- 125000003275 alpha amino acid group Chemical group 0.000 description 1
- 238000013459 approach Methods 0.000 description 1
- 230000008901 benefit Effects 0.000 description 1
- 238000004422 calculation algorithm Methods 0.000 description 1
- 238000004364 calculation method Methods 0.000 description 1
- 238000010276 construction Methods 0.000 description 1
- 238000011217 control strategy Methods 0.000 description 1
- 230000008878 coupling Effects 0.000 description 1
- 238000010168 coupling process Methods 0.000 description 1
- 238000005859 coupling reaction Methods 0.000 description 1
- 238000004519 manufacturing process Methods 0.000 description 1
- 238000012545 processing Methods 0.000 description 1
- 238000011160 research Methods 0.000 description 1
- 238000005070 sampling Methods 0.000 description 1
- 230000017105 transposition Effects 0.000 description 1
- 230000003313 weakening effect Effects 0.000 description 1
Landscapes
- Feedback Control In General (AREA)
Abstract
本发明涉及一种基于复合学习的受限机械臂有限时间控制方法,属于机器人控制技术领域,用于解决现有技术中复合学习自适应控制无法使系统在有限时间内稳定,且未考虑机械臂关节角度受限问题。本发明在现有复合学习控制理论基础上,通过构建通用时变非对称障碍函数实现对机械臂关节角度的直接约束,同时设计了基于改进非奇异终端滑模的有限时间控制方法,使跟踪误差和参数估计误差均能在有限时间收敛至0,并且不会出现奇异问题,大大提升了系统的控制性能,从而保证系统运行过程的可靠性和安全性。
Description
技术领域
本公开涉及机器人控制技术领域,尤其涉及一种基于复合学习的受限机械臂有限时间控制方法。
背景技术
机械臂是机器人技术领域中应用最为广泛的自动化机械装置,涉及工业制造、医疗、军事以及太空探索等诸多领域。要实现对机械臂的精准操控,需准确获取机械臂各项物理参数来构建其精确的动态模型,然而机械臂通常包含多个自由度,是典型的非线性、强耦合系统,当机械臂执行不同任务时,其动态模型中多项物理参数也会随之改变,这就导致其模型难以精确获得。因此,如何提高机械臂的参数辨识和同步控制性能是现有工业控制的研究热点。
当被控系统具有多项未知参数或不可测量参数时,复合自适应控制因其能同时保证跟踪误差和参数估计误差的收敛性而被认为是一种十分有效的控制策略。然而为确保控制性能,传统的自适应控制方法要求系统必须满足持续激励条件,这在实际上很难实现;在此背景下,复合学习控制方法应运而生。与传统自适应控制方法不同,复合学习控制运用当前实测数据和历史数据构建参数自适应估计策略,并将持续激励条件弱化为较易实现的区间激励条件。尽管复合学习自适应控制方法提升了系统的控制性能,但其仍存在一系列缺陷:目前该方法只能保证跟踪误差及参数估计误差指数收敛至0,并不能使系统在有限时间内稳定;另外,该方法未考虑机械臂关节角度受限问题,不能保证系统运行过程的可靠性和安全性。
发明内容
为克服当前机械臂复合学习自适应控制方法的不足,本发明提出一种考虑机械臂关节角度受限、满足机械臂系统有限时间稳定的复合学习控制方法。该方法在现有复合学习控制理论基础上,通过构建通用时变非对称障碍函数实现对机械臂关节角度的直接约束,同时设计了基于改进非奇异终端滑模的有限时间控制方法,使系统跟踪误差和参数估计误差均能在有限时间收敛至0,并且不会出现奇异问题,大大提升了系统的控制性能。
为了解决上述技术问题,本发明的技术方案如下。
一方面,本发明提供一种基于复合学习的受限机械臂有限时间控制方法,所述方法包括下述步骤:
S100、获取当前时间机械臂关节位置、速度,计算复合学习参数更新律;
S200、基于复合学习参数更新律更新参数估计值,进而计算有限时间的控制力矩,通过控制力矩控制机械臂按期望轨迹运动,且机械臂关节在设定区域内活动;
S300、若设定的时间未结束,获取下一时间为当前时间,返回步骤S100;
所述复合学习参数更新律如下:
其中:为参数更新律,P为投影算子,均为自适应增益矩阵,为控制参数且满足0<γ<1,为的范数;为未知参数向量θ的估计值,将未知参数向量的界设定为半径为cθ的球形范围ε为参数预测误差,为受限机械臂对应的动态回归矩阵;s为非奇异终端滑模面,为改进的激励矩阵:
t为时间,Te为区间激励条件的上边界,Θ(t)为激励矩阵。
在上述技术方案中,通过本发明提出的复合学习更新律,实现对机械臂模型未知参数的在线辨识,进而用于机械臂有限时间控制器的计算,实现对机械臂轨迹跟踪的同步控制。通过改进的激励矩阵弱化激励条件,使得参数估计误差和轨迹跟踪误差均能在较弱的区间激励条件下能够有限时间收敛至0,而不会出现奇异问题,从而使机械臂在较弱的区间激励条件下更快、更准确得获取模型参数真值,进而精准得控制机械臂运动状态。
在上述技术方案中,所述有限时间的控制力矩采用下式计算:
式中:控制器增益矩阵,n为关节总数,η1i为对通用时变非对称障碍函数求导后的系数,为qi的导数,qi为机械臂第i个关节的位置;
将通用时变非对称障碍函数记作ζi,则:
式中:F1i和F2i为时变障碍函数;F 1i和F 2i分别根据时变障碍函数F1i和F2i确定的非零常数,满足式qi=qi(t),Ωi(t)为机械臂第i个关节位置的限定范围,且满足qi(0)∈Ωi(0)。该通用时变非对称障碍函数,给出了机械臂关节角度受限下的n自由度动力学模型。与传统障碍李雅普诺夫函数法的间接约束相比,该障碍函数能直接约束机械臂关节角度,同时能在不改变系统控制结构的前提下满足机械臂关节角度受限和不受限两种情况的需求,保证了控制系统的安全性和可靠性。
在上述技术方案中,所述非奇异终端滑模面通过下述步骤获取:
根据受限机械臂动力学模型,获取计算机械臂关节位置受限条件下的跟踪误差eζ:
eζ=ζ-ζd
式中:ζd为受限机械臂期望轨迹,ζ为受限机械臂实际轨迹;
构建非奇异终端滑模面s如下:
式中:λ、γs、均为设定的控制参数,1/2<γs<1,当s到达0时eζ>u。当机械臂中有限时间控制器基于该非奇异终端滑模面计算时,可使机械臂跟踪误差及参数估计误差均能在有限时间收敛至0,并且不会出现奇异问题,大大提升了系统的收敛速度和控制精度。
在上述技术方案中,所述参数预测误差基于机械臂当前实测数据和历史数据构建,进而根据预测误差和参数估计误差设计改进的激励矩阵,改进的激励矩阵具有弱化的区间激励条件,从而使有限时间控制器能够在在较弱的区间激励条件下更快、更准确得获取模型参数真值,进而精准得控制机械臂运动状态。参数预测误差和改进的激励函数均具有积分项Θ(t),使得复合学习参数更新律计算不仅用到了系统当前实测数据,还用到了因积分项而生成的历史数据,进而使未知参数的估计值在有限时间控制器作用下,能够在较弱的区间激励条件下有限时间收敛至参数真值。
在上述技术方案中,所述参数预测误差与改进的激励矩阵的关系为:
式中:ε为参数预测误差,为参数估计误差,
在上述技术方案中,所述激励矩阵基于滤波回归矩阵获得,所述滤波回归矩阵通过对动力学模型回归矩阵进行滤波处理获得;所述动力学模型回归矩阵通过对动力学模型进行线性参数化处理获得。
在上述技术方案中,所述受限机械臂动力学模型通过下述步骤建立:
建立机械臂动力学模型:
式中:为正定惯性矩阵,为离心力和哥氏力矩阵,为粘滞摩擦力矩,为重力力矩,为控制力矩,分别为机械臂的关节位置、速度和加速度;
设置机械臂关节角度的限定范围:
式中:qi(t)为机械臂第i个关节的位置,Ωi(t)为机械臂第i个关节位置的限定范围,且满足qi(0)∈Ωi(0);F1i和F2i为两个k阶可导的时变障碍函数;
构建通用时变非对称障碍函数的分量ζi:
式中:F 1i和F 2i为非零常数,且满足式
对通用时变非对称障碍函数求导得:
其中:为ζ的导数;
得到受限机械臂动力学模型为:
其中:
为使动力学模型等式成立的任意辅助向量,为ξ的导数,为机械臂关节位置受限后对应的动态回归矩阵,为的转置。
在上述技术方案中,所述受限机械臂的控制模式包括定点控制模式和跟踪控制模式。
第二方面,本发明提出一种基于复合学习的受限机械臂有限时间控制装置,包括存储器和处理器,所述存储器上存储有能够被处理器加载并执行上述任一种方法的计算机程序。
第三方面,本发明提出一种计算机可读存储介质,存储有能够被处理器加载并执行上述任一种方法的计算机程序。
附图说明
为了更清楚地说明本申请实施例中的技术方案,下面将对实施例描述中所需要使用的附图作简单地介绍,显而易见地,下面描述中的附图仅仅是本申请的一些实施例,对于本领域普通技术人员来讲,在不付出创造性劳动性的前提下,还可以根据这些附图获得其他的附图。
图1、为一种实施方式中的方法流程示意图;
图2、为一种实施方式中的常规2自由度机械臂简化示意图;
图3(a)、为一种实施方式中在定点控制模式下的机械臂关节1轨迹跟踪效果图;
图3(b)、为一种实施方式中在定点控制模式下的机械臂关节2轨迹跟踪效果图;
图4、为一种实施方式中定点控制模式下的机械臂参数估计效果示意图;
图5(a)、为一种实施方式中在跟踪控制模式下的机械臂关节1轨迹跟踪效果图;
图5(b)、为一种实施方式中在跟踪控制模式下的机械臂关节2轨迹跟踪效果图;
图6、为一种实施方式中跟踪控制模式下的机械臂参数估计效果示意图。
具体实施方式
下面将结合本申请实施例中的附图,对本申请实施例中的技术方案进行清楚、完整地描述,显然,所描述的实施例仅仅是本申请一部分实施例,而不是全部的实施例。
在本发明中,为实数,为n维实向量,为n×n阶实矩阵,为m×n阶实矩阵,为m维实向量,为正实数。
参见图1,在一种实施方式中,基于复合学习的受限机械臂有限时间控制方法,如下详述。
S100、获取的机械臂关节位置、速度数据,并基于获取的机械臂关节位置、速度数据,计算复合学习参数更新律、有限时间控制器;
【步骤1】:构建考虑关节位置受限的机械臂动力学模型。
(1.1)建立如式(1)所示的n自由度机械臂动力学模型:
式(1)中:为正定惯性矩阵,为离心力和哥氏力矩阵,为粘滞摩擦力矩,为重力力矩,为控制力矩,分别为机械臂的关节位置、速度和加速度。
上述机械臂动力学模型为未受限机械臂模型,其具备如下性质:
性质1:M(q)为正定对称矩阵,满足为任意向量,||ξ||为ξ的范数,m和为正常数。
性质2:是斜对称矩阵。
性质3:(1)式左侧可以写成如下形式:
式(2)中:为包含关节速度项且满足(2)式成立的辅助向量,为ξ的导数,为动态回归矩阵,为的转置,为由机械臂未知参数所构成的向量。
通过式(2)将机械臂动力学模型公式的左侧进行线性参数化处理,写成回归矩阵的转置与未知参数向量θ相乘的形式,其中回归矩阵中的各个参数均可测,只有θ中的各参数向量未知。
(1.2)构建通用时变非对称障碍函数
机械臂关节角度的限定范围为:
式(3)中:qi(t)为机械臂第个关节的位置,Ωi(t)为机械臂第i个关节位置的限定范围,且满足qi(0)∈Ωi(0);F1i和F2i为两个k阶可导的时变障碍函数,且满足k≥2。
构建通用时变非对称障碍函数:
式(4)中:F 1i和F 2i为非零常数,且满足式即:当障碍函数F1i和F2i选定后,即可确定F 1i和F 2i的值;qi为式(3)中的qi(t)。
从式(4)可以看出,当且仅当qi→-F1i或qi→F2i时,ζi→∞,因此只要保证ζi有界,即可满足qi∈Ωi。若F1i和F2i取无穷大,则有:
该结果表明构建的通用时变非对称障碍函数ζi等价于机械臂未受限时的qi,因此,无需改变系统控制结构,即可满足机械臂关节角度受限和不受限两种情况的需求。
(1.3)给出考虑机械臂关节角度受限的动力学模型
对障碍函数(4)求导可得:
其中:
将式(6)写成紧凑形式为:
其中:
将式(8)代入式(1)得:
将(10)式两端同时乘以得到考虑关节位置受限的机械臂动力学模型为:
其中:
根据性质1-3可推导出式(11)具有如下性质,即受限机械臂模型所具备的性质:
性质4:H(q,η1)为正定对称矩阵,满足 为任意向量,h和为正常数,其中qi(t)∈Ωi(t),i=1,2,…,n;
性质5:是斜对称矩阵;
性质6:(11)式左侧可以写成如下形式:
式(13)中,为机械臂关节位置受限后对应的动态回归矩阵,为转置。
【步骤2】基于系统当前实测数据和历史数据构建模型参数预测误差并设计改进的激励矩阵。
(2.1)对机械臂动力学模型中的力矩及回归矩阵进行线性滤波处理。
当时,代入式(2)可得:
将(14)式代入(1)式得到:
上式中包含的关节角度加速度项通常无法直接测量,因此,需首先对上述动力学模型中的力矩及回归矩阵进行滤波处理,解决加速度不可测的技术问题:
得到:
其中:
为滤波系数,为用户自定义值,τf(t)为τ(t)的滤波后结果,为的滤波后结果。
2.2定义激励矩阵:
将(17)式等式两端同时乘以并在区间上积分可得:
将(18)式等式两端同时乘以固定的未知参数向量θ并代入公式(17)可得激励矩阵Θ(t):
2.3设计模型参数预测误差:
区间激励条件:当t∈[Te-t1,Te]时,若存在正常数Te,t1,σ,使得成立,则称矩阵满足区间激励条件,其中I为单位矩阵。
持续激励条件:任取t>0,若存在正常数t1,σ,使得成立,则称矩阵满足持续激励条件。
在传统复合自适应控制方法中,往往需要机械臂滤后矩阵满足持续激励条件才能保证参数估计误差收敛至0,而这在现实中很难实现,为将持续激励条件弱化为可行的区间激励条件,构建如下包括实测数据和历史数据在内的参数预测误差:
式(20):ε(t)为参数预测误差,为未知参数向量θ的估计值,定义参数估计误差参数估计值是对未知参数向量的估计,通过设计复合学习参数更新律,实现对参数估计值的不断更新,最终使参数估计值等于参数真值,即保证参数估计误差收敛至0。
2.4获取改进的激励矩阵
改进的激励矩阵为如下分段函数形式:
当系统满足区间激励条件,即存在正常数Te,σ,使成立时,相比于激励矩阵,激励条件得以弱化,提升了复合学习参数更新律对实现准确参数估计的可行性。
由式(20)和式(21),易得到参数预测误差与改进的激励矩阵的关系为:
【步骤3】设计复合学习参数更新律和基于改进非奇异终端滑模的机械臂有限时间控制器。
(3.1)根据受限机械臂动力学模型,定义机械臂关节位置受限条件下的跟踪误差eζ:
eζ=ζ-ζd (23)
式(23)中:ζd为受限机械臂期望轨迹,其中:
(3.2)获取非奇异终端滑模面
式(25)-(27)中:φ(eζ)为关于非奇异终端滑模面的分段函数,λ、γs、均为控制参数,用于控制系统收敛速度,为用户自定义值。1/2<γs<1,μ为根据经验所取的较小正数,满足当s到达0时eζ>u。
3.3运用跟踪误差、改进的激励矩阵及参数预测误差设计复合学习参数更新律
定义如下辅助变量
对s求导,并将等式两侧同时乘以H(q,η1),将所得结果代入公式(11)并运用公式(28)及性质6可得:
式(29)中:为引入辅助变量后相应的受限机械臂动态回归矩阵,
至此,可得复合学习参数更新律
式中:P为投影算子,均为自适应增益矩阵,通常取正定对角矩阵,为辅助变量的导数,为控制参数且满足0<γ<1,为的范数,位置参数向量的界由用户根据预先获取的机械臂模型参数粗略信息自行进行设定,如机械臂杆质量不会超过a1,机械臂杆长不会超过a2等,根据此信息经运算后可将未知参数向量的界设定为半径为cθ的球形范围即:
3.4设计基于改进非奇异终端滑模的机械臂有限时间控制器:
式(32)中:控制器增益矩阵,一般设定为正定对角阵。
相比于传统控制器(如PID控制器),有限时间控制器能够提升系统稳定速度。通过有限时间控制器实时控制机械臂运动,使机械臂实际运动轨迹能在有限时间内准确追踪到预定轨迹,同时结合参数更新律,使未知参数估计值能在有限时间内收敛至其真值。
S200、基于复合学习参数更新律更新参数估计值,进而计算有限时间的控制力矩,通过控制力矩控制机械臂按期望轨迹运动,且机械臂关节在设定区域内活动;
参数更新律相当于未知参数向量的变化率,可用下式计算:
为根据式(30)实时计算的经过c-1个时间步长后的参数更新律,为初始给定值,为经c个时间步长后更新得到的未知参数估计值,为其上一时刻的未知参数估计值,c=1,2,...,o,o为正整数,Δtb为用户自定义时间步长,下面实验中取1ms。
S300、若设定的时间未结束,获取下一时间为当前时间,返回步骤S100。
本发明中的有限时间控制包括两方面内容,一是控制受限机械臂在有限时间内实现对预定轨迹的准确跟踪,二是在有限时间内结合复合学习参数更新律实现对机械臂模型未知参数的准确估计/辨识。
上述系统的有限时间稳定性,通过李雅普诺夫函数分析可以得到验证,即:机械臂系统在所设计的有限时间控制器τ及复合学习参数更新律的作用下,若满足初始条件qi(0)∈Ωi(0),且存在Te>0使区间激励条件成立,则机械臂模型参数估计误差和轨迹跟踪误差均能在较弱的区间激励条件下有限时间收敛至0,并且不会出现奇异问题;同时,机械臂各关节将一直在所限定的范围内活动。
对下式中的V1对时间t求导并通过稳定性分析可得:s和均在有限时间收敛至0:
当s=0时,结合式(25)和(26)可得:
对下式中的V2对时间t求导并通过稳定性分析可得:eζ在有限时间收敛至0,进而得到e也在有限时间收敛至0。
为验证所提方法的有效性,进行了如下实验:
实验选择2自由度机械臂,其结构如图2所示,两关节电机的齿轮齿数比分别为160∶1和120∶1,角坐标分辨率分别为3×10-7和4×10-7rad,用户在MATLAB/Simulink中运行所设计控制算法,实时计算机械臂关节控制力矩,进而控制机械臂运动,控制器的采样时间设置为1ms。对二自由度机械臂,取机械臂模型未知参数向量为θ=[θ1,θ2,...,θ7],其中:θ3=m2l1le2,θ4=m1lc1+m2l1,θ5=m2lc2,θ6=kv1,θ7=kv2;未知参数向量公式中:I1和I2为机械臂两杆转动惯量,m1和m2为机械臂两杆质量,l1和l2为机械臂两杆长度,lc1和lc2为机械臂两杆质心到轴端的距离,kv1和kv2为粘滞摩擦系数。
为保证结果的充分性,进行定点控制模式和跟踪控制模式两种情况的实验。
1、定点控制模式:
设置期望轨迹为:
其中:取i=1,2;为用户自定义向量,当t∈[1,3)s时,取(qc1,qc2)=(-π/4,-π/3),当t∈[3,5)s时,取(qc1,qc2)=(π/4,π/3),当t取其它值时,取(qc1,qc2)=(0,0);qd(0)=[π/12,-π/4],机械臂两关节位置限制区域为:Ω1={q1(t):-0.65-0.02sin(2t)<q1(t)<0.65-0.02cos(2t)},Ω2={q2(t):-0.9-0.02sin(2t)<q2(t)<-0.3-0.02cos(2t)},q(0)=[0,-π/6]T,F 11=-0.1,F 21=-0.1,F 12=-0.05,F 22=-0.05;控制器参数选取如下:K1=200I,Γ=0.01I,K2=0.3I,γ=γs=0.6,λ=0.6,μ=0.01,t1=4,α=5,τf(0)=[0,0]T,
当t>8s时,激励强度趋近于0,表明不存在持续激励情况。图3和图4分别为机械臂轨迹跟踪效果图和参数估计效果图。由图可以看出,所设计的控制器能控制机械臂关节位置轨迹q准确地追踪到期望轨迹qd,也能使参数估计值收敛至参数真值θ。与此同时,机械臂关节位置q能一直在限定区域内活动,证明了通用时变非对称障碍函数的有效性。
2、跟踪控制模式:
根据反动力学模型设置期望轨迹:
其中:xd1=0.5+0.2cos(πt),xd2=0.5+0.2sin(πt),机械臂关节角度限制区域如下:Ω1={q1(t):-0.7-0.02sin(2t)<q1(t)<0.7-0.02cos(2t)},Ω2={q2(t):0.2-0.02sin(2t)<q2(t)<1.1-0.02cos(2t)};取q(0)=[3π/20,π/8]T,F 11=-0.1,F 21=-0.1,F 12=-0.05,F 22=-0.05,控制器参数选取如下:K1=500I,Γ=0.1I,K2=0.1I,γ=γs=0.6,λ=0.6,μ=0.01,t1=4,α=5,τf(0)=[0,0]T,
图5(a)、图5(b)分别为机械臂关节1和关节2的轨迹跟踪效果图,图6为参数估计效果图,结果表明,该控制方法在跟踪控制模式下也具有良好的控制性能,在满足受限条件的情况下,保证了关节位置误差和参数估计误差的收敛性。
通过以上的实施方式的描述,所属领域的技术人员可以清楚地了解到本公开可借助软件加必需的通用硬件的方式来实现,当然也可以通过专用硬件包括专用集成电路、专用CPU、专用存储器、专用元器件等来实现。一般情况下,凡由计算机程序完成的功能都可以很容易地用相应的硬件来实现,而且,用来实现同一功能的具体硬件结构也可以是多种多样的,例如模拟电路、数字电路或专用电路等。但是,对本公开而言更多情况下,软件程序实现是更佳的实施方式。
尽管以上结合附图对本发明的实施方案进行了描述,但本发明并不局限于上述的具体实施方案和应用领域,上述的具体实施方案仅仅是示意性的、指导性的,而不是限制性的。本领域的普通技术人员在本说明书的启示下和在不脱离本发明权利要求所保护的范围的情况下,还可以做出很多种的形式,这些均属于本发明保护之列。
Claims (9)
1.一种基于复合学习的受限机械臂有限时间控制方法,其特征在于,所述方法包括下述步骤:
S100、获取当前时间机械臂关节位置、速度,计算复合学习参数更新律;
S200、基于复合学习参数更新律更新参数估计值,进而计算有限时间的控制力矩,通过控制力矩控制机械臂按期望轨迹运动,且机械臂关节在设定区域内活动;
S300、若设定的时间未结束,获取下一时间为当前时间,返回步骤S100;
所述复合学习参数更新律如下:
其中:为参数更新律,P为投影算子,均为自适应增益矩阵,为控制参数且满足0<γ<1,为的范数;为未知参数向量θ的估计值,将未知参数向量的界设定为半径为cθ的球形范围ε为参数预测误差,为受限机械臂对应的动态回归矩阵;s为非奇异终端滑模面,为改进的激励矩阵:
t为时间,Te为使区间激励条件成立的时间上边界,Θ(t)为激励矩阵;
所述有限时间的控制力矩采用下式计算:
式中:控制器增益矩阵,n为关节总数,η1i为对通用时变非对称障碍函数求导后的系数,为qi的导数,qi为机械臂第i个关节的位置;
将通用时变非对称障碍函数记作ζi,则:
式中:F1i和F2i为时变障碍函数;F 1i和F 2i分别根据时变障碍函数F1i和F2i确定的非零常数,满足式qi=qi(t),Ωi(t)为机械臂第i个关节位置的限定范围,且满足qi(0)∈Ωi(0)。
2.根据权利要求1所述的方法,其特征在于,所述非奇异终端滑模面通过下述步骤获取:
根据受限机械臂动力学模型,获取计算机械臂关节位置受限条件下的跟踪误差eζ:
eζ=ζ-ζd
式中:ζd为受限机械臂期望轨迹,ζ为受限机械臂实际轨迹;
构建非奇异终端滑模面s如下:
式中:λ、γs、均为设定的控制参数,1/2<γs<1,当s到达0时eζ>u。
3.根据权利要求1所述的方法,其特征在于,所述参数预测误差基于机械臂当前实测数据和历史数据构建。
4.根据权利要求3所述的方法,其特征在于,所述参数预测误差与改进的激励矩阵的关系为:
式中:ε为参数预测误差,为参数估计误差,
5.根据权利要求1所述的方法,其特征在于,所述激励矩阵基于滤波回归矩阵获得,所述滤波回归矩阵通过对动力学模型回归矩阵进行滤波处理获得;所述动力学模型回归矩阵通过对动力学模型进行线性参数化处理获得。
6.根据权利要求2所述的方法,其特征在于,所述受限机械臂动力学模型通过下述步骤建立:
建立机械臂动力学模型:
式中:为正定惯性矩阵,为离心力和哥氏力矩阵,为粘滞摩擦力矩,为重力力矩,为控制力矩,分别为机械臂的关节位置、速度和加速度;
设置机械臂关节角度的限定范围:
式中:qi(t)为机械臂第i个关节的位置,Ωi(t)为机械臂第i个关节位置的限定范围,且满足qi(0)∈Ωi(0);F1i和F2i为两个k阶可导的时变障碍函数,满足k≥2;
构建通用时变非对称障碍函数的分量ζi:
式中:F 1i和F 2i为非零常数,且满足式
对通用时变非对称障碍函数求导得:
其中:为ζ的导数;
得到受限机械臂动力学模型为:
其中:
为使动力学模型等式成立的任意辅助向量,为ξ的导数,为机械臂关节位置受限后对应的动态回归矩阵,为的转置。
7.根据权利要求1所述的方法,其特征在于,所述受限机械臂的控制模式包括定点控制模式和跟踪控制模式。
8.一种基于复合学习的受限机械臂有限时间控制装置,其特征在于:包括存储器和处理器,所述存储器上存储有能够被处理器加载并执行如权利要求1至7中任一种方法的计算机程序。
9.一种计算机可读存储介质,其特征在于:存储有能够被处理器加载并执行如权利要求1至7中任一种方法的计算机程序。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202211513838.1A CN115847404B (zh) | 2022-11-28 | 2022-11-28 | 一种基于复合学习的受限机械臂有限时间控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202211513838.1A CN115847404B (zh) | 2022-11-28 | 2022-11-28 | 一种基于复合学习的受限机械臂有限时间控制方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN115847404A CN115847404A (zh) | 2023-03-28 |
CN115847404B true CN115847404B (zh) | 2024-07-05 |
Family
ID=85667933
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202211513838.1A Active CN115847404B (zh) | 2022-11-28 | 2022-11-28 | 一种基于复合学习的受限机械臂有限时间控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN115847404B (zh) |
Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN111496792A (zh) * | 2020-04-27 | 2020-08-07 | 北京科技大学 | 一种机械臂输入饱和固定时间轨迹跟踪控制方法及系统 |
CN114454150A (zh) * | 2021-12-31 | 2022-05-10 | 新加坡国立大学 | 一种基于复合学习的臂式机器人控制方法及机器人系统 |
Family Cites Families (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
KR101724872B1 (ko) * | 2015-07-14 | 2017-04-07 | 재단법인대구경북과학기술원 | 빠르고 강건한 궤적 설계를 통한 산업용 로봇의 파라미터 추정 방법 |
CA3000688A1 (en) * | 2015-09-30 | 2017-04-06 | Barrett Technology, Llc | Multi-active-axis, non-exoskeletal rehabilitation device and a method of operating thereof |
WO2017132905A1 (zh) * | 2016-02-03 | 2017-08-10 | 华为技术有限公司 | 控制运动系统的方法和装置 |
CN110687787B (zh) * | 2019-10-11 | 2022-11-25 | 宁波耀华电气科技有限责任公司 | 一种机械臂系统自适应控制方法 |
CN112276954B (zh) * | 2020-10-29 | 2021-11-09 | 青岛大学 | 基于有限时间输出状态受限的多关节机械臂阻抗控制方法 |
CN114571451B (zh) * | 2022-02-25 | 2023-08-22 | 山东新一代信息产业技术研究院有限公司 | 一种可调漏斗边界的自适应滑模控制方法及设备 |
CN114800489B (zh) * | 2022-03-22 | 2023-06-20 | 华南理工大学 | 基于确定学习与复合学习联合的机械臂柔顺控制方法、存储介质及机器人 |
CN114815624A (zh) * | 2022-05-25 | 2022-07-29 | 国网黑龙江省电力有限公司绥化供电公司 | 一种多自由度机器人系统的滑模轨迹跟踪控制方法 |
-
2022
- 2022-11-28 CN CN202211513838.1A patent/CN115847404B/zh active Active
Patent Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN111496792A (zh) * | 2020-04-27 | 2020-08-07 | 北京科技大学 | 一种机械臂输入饱和固定时间轨迹跟踪控制方法及系统 |
CN114454150A (zh) * | 2021-12-31 | 2022-05-10 | 新加坡国立大学 | 一种基于复合学习的臂式机器人控制方法及机器人系统 |
Also Published As
Publication number | Publication date |
---|---|
CN115847404A (zh) | 2023-03-28 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN104950678B (zh) | 一种柔性机械臂系统的神经网络反演控制方法 | |
Sauvée et al. | Image based visual servoing through nonlinear model predictive control | |
CN112207834B (zh) | 一种基于干扰观测器的机器人关节系统控制方法及系统 | |
CN111716360B (zh) | 一种基于模糊逻辑的柔性关节机械臂采样控制方法及装置 | |
Chen et al. | Adaptive fixed-time backstepping control for three-dimensional trajectory tracking of underactuated autonomous underwater vehicles | |
CN111965976B (zh) | 基于神经网络观测器的机器人关节滑模控制方法及系统 | |
Ribeiro et al. | Nonlinear model predictive visual path following control to autonomous mobile robots | |
Oliveira et al. | Overcoming limitations of uncalibrated robotics visual servoing by means of sliding mode control and switching monitoring scheme | |
El-Sousy et al. | Robust adaptive super-twisting sliding mode stability control of underactuated rotational inverted pendulum with experimental validation | |
Ma et al. | Adaptive output feedback control of steer-by-wire systems with event-triggered communication | |
CN106950842B (zh) | 解耦控制方法、装置、机器人及存储介质 | |
Hu et al. | Vision-based impedance control of an aerial manipulator using a nonlinear observer | |
CN109709807B (zh) | 一种基于摩擦补偿的自适应神经网络控制方法及其装置 | |
Han et al. | Backstepping sliding mode control with FWNN for strict output feedback non-smooth nonlinear dynamic system | |
CN114179089A (zh) | 一种机械臂的鲁棒区域跟踪控制方法 | |
CN115847404B (zh) | 一种基于复合学习的受限机械臂有限时间控制方法 | |
Al-Shuka et al. | Adaptive hybrid regressor and approximation control of robotic manipulators in constrained space | |
CN116690561A (zh) | 一种用于单连杆机械臂的自适应最优反步控制方法及系统 | |
CN116330297A (zh) | 一种柔性机械臂关节系统的自适应控制器、模块及机器人 | |
CN112947066B (zh) | 一种机械手改进有限时间反演控制方法 | |
An et al. | Prediction of angular acceleration for practical realization of incremental nonlinear trajectory-tracking control for aircrafts | |
CN112632803A (zh) | 跟踪控制方法和装置、电子设备及存储介质 | |
Hashimoto et al. | Visual servoing with linearized observer | |
Yu et al. | Experiment and controller design for two-wheeled robot with nonlinear damping and road disturbance | |
Kamath et al. | Back-stepping Nonlinear Integral Sliding Mode Control of a Vision Augmented 3 DoF Quadrotor in the presence of System Uncertainties and Bounded Disturbances |
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 |