法律状态公告日
法律状态信息
法律状态
2020-03-24
授权
授权
2018-05-01
实质审查的生效 IPC(主分类):G05B13/04 申请日:20171226
实质审查的生效
2018-04-03
公开
公开
技术领域
本发明属于六自由度机器臂轨迹跟踪技术领域,更为具体地讲,涉及一种基于分数阶幂次趋近律的终端滑模机械臂轨迹跟踪方法。
背景技术
随着控制理论及机械技术的发展,机械臂在工业领域得到了越来越广泛的应用。但是机械臂系统是一个复杂的非线性模型,同时由于模型参数不可能准确的测量从而造成建模失配,所以精确建立一个机械臂模型是非常困难的,而且在实际控制中模型会受到外界未知干扰的影响。而现在在工业领域,机械手在执行复杂任务时,轨迹跟踪的高精度是主要关心的内容。所以机械臂的运动控制已经成为一个重要的研究领域,并且出现了各种各样的控制方法。
滑模控制的能够克服系统的不确定性,对干扰和未建模动态具有很强的鲁棒性,尤其是对非线性系统具有良好的控制效果,从而在机器人控制领域得到了广泛的应用。但由于在控制过程中频繁切换控制结构,使控制器的输出出现较大的抖振现象,导致系统不能达到理想滑动模态。基于抖振问题,已有很多先进的方法被提出,例如,边界层法、滑模区域法、趋近率法等,其均能从一定程度上克服或减少抖振,但均以花费更长的响应时间或是跟踪误差较大为代价的。对于高精度要求的多连杆机械臂系统中,响应时间的长短,跟踪误差的大小均是其不可忽略的性能指标。
发明内容
本发明的目的在于克服现有技术的不足,提供一种基于分数阶幂次趋近律的终端滑模机械臂轨迹跟踪方法,在切换控制中设计分数阶幂次趋近律的滑模控制,能有效降低控制器的抖震,同时可以更快的在有限时间内跟踪到期望关节角轨迹。
为实现上述发明目的,本发明一种基于分数阶幂次趋近律的终端滑模机械臂轨迹跟踪方法,其特征在于,包括以下步骤:
(1)、设期望的六自由度机械臂末端位姿信息为P,P∈R4×4为齐次变换矩阵,由机械臂逆运动学将末端位姿信息P解算为各个关节的期望关节角qd,qd∈R6且qd=[qd1,qd2,...,qd6]T,R6表示6维的实数;
(2)、建立六自由度机械臂的动力学模型:
其中,
设六自由度机械臂的动力学模型的实际关节角输出为q,则关节角的角度跟踪误差为:e=q-qd;
比较角度跟踪误差e与预设阈值ζ的大小,如果e<ζ,则运行结束,否则进入步骤(3);
(3)、根据角度跟踪误差e设计线性滑模面s和非奇异快速终端滑模面σ
(3.1)、线性滑模面s为:
其中,
(3.2)、非奇异快速终端滑模面σ为:
其中,γ1=diag(γ11,γ12,...,γ1n),γ2=diag(γ21,γ22,...,γ2n),p1,p2为正的奇数且有1<p1/p2<2,p0>p1/p2,
(4)、根据线性滑模面s和非奇异快速终端滑模面σ设计等效控制器u0对非奇异快速终端滑模面σ求一阶导,得:
令
其中,
(5)、设计基于分数阶符号函数的幂次趋近律的切换控制器u1
其中,
(6)、将等效控制器和切换控制器相加并积分,得到最终的控制器τ;
(7)、在控制器τ的控制下,六自由度机械臂的动力学模型输出实际的关节角q*,再利用q*替代假设的q,并返回步骤(2),完成机械臂轨迹跟踪。
本发明的发明目的是这样实现的:
本发明一种基于分数阶幂次趋近律的终端滑模机械臂轨迹跟踪方法,通过设计对不确定上界的自适应率和分数阶幂次趋近的切换控制,使系统状态更快的收敛到滑模面上,再通过非奇异快速终端滑模面的滑模特性,使系统状态在有限时间内更快的收敛到平衡点,即跟踪误差收敛到0,从而实现对期望关节角轨迹的跟踪。
同时,本发明一种基于分数阶幂次趋近律的终端滑模机械臂轨迹跟踪方法还具有以下有益效果:
(1)、针对抖振现象,本发明采用积分器对控制器的输出进行积分,将不连续的控制信号转化为连续信号,从而有效减小了控制的抖震;
(2)、本发明对滑模控制算法进行了改进,设计一个分数阶滑模控制算法,在切换控制中引入了分数阶幂次趋近律,加快了向滑模面的趋近速度,提高了效率;其次,引入分数阶次扩大了系统的性能调节范围,具有更好的适应性;
(3)、本发明针对被控机械臂系统的建模失配和外界干扰,引入了自适应法则,对系统的不确定性上界进行估计,从而有效解决了在没有先验知识的前提下,对不确定性的抑制问题,提高了系统的鲁棒性;
(4)、本发明采用了非奇异快速终端滑模面,能够有效避免滑模面的奇异问题,而且能够保证系统状态可以在有限时间内快速的收敛到平衡点,即跟踪误差为0,实现机械臂关节角的精确跟踪。
附图说明
图1是本发明基于分数阶幂次趋近律的终端滑模机械臂轨迹跟踪方法流程图;
图2是六自由度机械臂关节角跟踪曲线(分数阶次a=0.25);
图3是六自由度机械臂关节角跟踪误差(分数阶次a=0.25);
图4是自适应参数随时间的变化曲线(分数阶次a=0.25);
图5是控制方法对六自由度机械臂的实际控制值(分数阶次a=0.25);
图6是非奇异快速终端滑模变量随时间的变化(分数阶次a=0.25);
图7是整数阶(a=0)和分数阶(a=0.511)轨迹跟踪曲线图;
图8是整数阶(a=0)和分数阶(a=0.511)的滑模变量随时间变化曲线图。
具体实施方式
下面结合附图对本发明的具体实施方式进行描述,以便本领域的技术人员更好地理解本发明。需要特别提醒注意的是,在以下的描述中,当已知功能和设计的详细描述也许会淡化本发明的主要内容时,这些描述在这里将被忽略。
实施例
图1是本发明基于分数阶幂次趋近律的终端滑模机械臂轨迹跟踪方法流程图。
在本实施例中,将本发明应用于六自由度机械臂的控制,即对机械臂的六个关节角进行轨迹跟踪。下面结合图1,对本发明一种本发明基于分数阶幂次趋近律的终端滑模机械臂轨迹跟踪方法进行详细说明,具体包括以下步骤:
S1、针对具体的任务需求,设期望的六自由度机械臂末端位姿序列信息为P,P∈R4×4为齐次变换矩阵,由机械臂逆运动学将末端位姿信息P解算为各个关节的期望关节角qd,qd∈R6且qd=[qd1,qd2,...,qd6]T,R6表示6维的实数;
S2、建立六自由度机械臂的动力学模型:
其中,
设六自由度机械臂的动力学模型的实际关节角输出为q,则关节角的角度跟踪误差为:e=q-qd;
比较角度跟踪误差e与预设阈值ζ的大小,如果e<ζ,则运行结束,否则进入步骤S3;
S3、根据角度跟踪误差e设计线性滑模面s和非奇异快速终端滑模面σ
S3.1、线性滑模面s为:
其中,
S3.2、非奇异快速终端滑模面σ为:
其中,γ1=diag(γ11,γ12,...,γ1n),γ2=diag(γ21,γ22,...,γ2n),p1,p2为正的奇数且有1<p1/p2<2,p0>p1/p2,
在本实施例中,采用了非奇异快速终端滑模面,能够有效避免滑模面的奇异问题,而且能够保证系统状态可以在有限时间内快速的收敛到平衡点,即跟踪误差为0,实现机械臂关节角的精确跟踪。
S4、根据线性滑模面s和非奇异快速终端滑模面σ设计等效控制器u0
对非奇异快速终端滑模面σ求一阶导,得:
令
其中,
S5、设计基于分数阶符号函数的幂次趋近律的切换控制器u1
其中,
其中,
本发明针对系统误差和外界干扰上界进行估计,从而有效解决了在没有先验知识的前提下,对不确定性的抑制问题,提高了系统的鲁棒性;下面我们对自适应参数
利用死区技术对非奇异终端滑模面的范数||σ||=0的[0,+ε)邻域进行处理,处理后的自适应参数为:
其中,ρ0,ρ1,ρ2为正的可调参数,ε为一个很小的正常数。
这样通过在切换控制中引入了分数阶幂次趋近律,加快了向滑模面的趋近速度,提高了效率;其次,引入分数阶次扩大了系统的性能调节范围,具有更好的适应性。
S6、将等效控制器和切换控制器相加并积分,得到最终的控制器τ;
在本实施例中,采用积分器对控制器的输出进行积分,将不连续的控制信号转化为连续信号,从而有效减小了控制的抖震。
S7、在控制器τ的控制下,六自由度机械臂的动力学模型输出实际的关节角q*,再利用q*替代假设的q,并返回步骤S2,经过闭环反馈,最终跟踪到期望的关节角轨迹。
实例
在本实例中,我们先针对分数阶阶次a=0.25时,进行本发明所提出方法可行性的验证。然后在整数阶a=0和分数阶a=0.511时,进行对比分析。下面对仿真中用到的参数进行说明。
设六自由度机械臂系统内部有十二个状态x∈R12且
期望的各关节角的轨迹为:
qd1=3.75-(7/5)e-t+(7/20)e-4t,qd2=1.25+e-t-(1/4)e-4t,qd3=1.25-(6/5)e-t+(6/20)e-4t,
qd4=3.25-e-t+(5/20)e-4t,qd5=0.25-(4/5)e-t+(4/20)e-4t,qd6=4.25-(3/5)e-t+(3/20)e-4t。
机械臂系统的初始状态选择为:
qi(0)=0.3491,(i=1,2,4,6),q3(0)=2,q5(0)=0.1,
外部干扰项为:
τdi=0.2sin(t)+0.05sin(200πt),i=1,3,4,6,τd2=0.1cos(2t)+0.05sin(200πt),
τd5=0.1sin(200πt)。
针对本发明所提出的控制器,参数选取为:
β=diag(30,30,30,30,30,30),γ1=diag(0.1,0.1,0.1,0.1,0.1,0.1),
γ2=diag(0.02,0.02,0.02,0.02,0.02,0.02),p0=1.5,p1=15,p2=13。自适应参数:
ρ0=0.3,ρ1=0.25,ρ2=0.57,ε=0.1。初始值
切换控制中参数的选取:切换控制中幂次趋近律的幂α=0.5,K*=diag(100,80,120,120,40,180)。
将上述参数加到所提出的控制器及仿真模型中,得到下面的仿真结果。这里切换控制中分数阶的阶次选取a=0.25,并且进行控制方法可行性的验证。
图2为六自由度机械臂六个关节角的跟踪曲线,其中qdi,(i=1,...,6)为期望的关节角轨迹,qi,(i=1,...,6)为实际跟踪曲线。由图可以看出在外界干扰存在的情况下,本发明所提出的控制方法可以有效的跟踪到期望的关节角轨迹。
图3为机械臂六个关节角的跟踪误差,由图中可以看出,6个关节角误差均能在有限时间内快速收敛到0,从而体现了快速终端滑模的功效,即可以使系统状态在有限时间内快速收敛到系统的平衡点。
图4所示为自适应参数随时间的变化曲线,由图可以看出,该自适应法则可以对系统的不确定性上界进行估计,当估计值可以使滑模变量到达滑模面附近时,运用死区技术使该自适应参数不再增长,从而有效抑制了外界干扰和建模失配对控制性能的影响。
图5所示为六自由度机械臂的实际控制值τ,每个分量记为τi,i=1,...,6。由图中可以看出,各控制值是相对平滑的,通过对实际切换控制的积分,有效抑制了由切换控制带来的抖震问题,提高了控制的性能。
图6所示为在分数阶阶次a=0.25时,滑模变量σ随时间的变化曲线,每个分量记为σi,i=1,...,6。由图中可以看出,6维的滑模变量σ在切换控制的作用下向滑模面运动,到达滑动模态,体现了本发明分数阶幂次趋近的切换控制的有效性。
接下来针对本发明提出的控制方法,进行整数阶和分数阶控制方法的对比分析。保持上述控制方法和机械臂模型参数不变,只修改切换控制中分数阶的阶次为a=0和a=0.511。图7所示为整数阶次和分数阶的轨迹跟踪曲线对比,跟踪到期望轨迹的时间如表1所示。
表1
由该表1可以看出,当分数阶切换控制的阶次为0.511时,关节角的跟踪速度比整数阶的快,从而体现了本发明的优势,即增加参数的可调范围,提升算法的适用性,从而提升控制性能。
图8所示为整数阶次和分数阶的非奇异终端滑模面随时间的变化对比,具体的收敛到滑模面的时间如表2所示。
表2
由表2中可以看出,当分数阶次为0.511时,滑模变量σ趋向滑模面(即σ=0)的速度比整数阶的快,从而体现了分数阶幂次切换控制的性能,更快的进入滑动模态,从而提升跟踪误差的收敛速度,最终使关节角更快的收敛到期望值。
尽管上面对本发明说明性的具体实施方式进行了描述,以便于本技术领域的技术人员理解本发明,但应该清楚,本发明不限于具体实施方式的范围,对本技术领域的普通技术人员来讲,只要各种变化在所附的权利要求限定和确定的本发明的精神和范围内,这些变化是显而易见的,一切利用本发明构思的发明创造均在保护之列。
机译: 使用中心离散离散虚幂分数阶傅立叶变换和高精度正交特征向量校正数字图像中的过聚焦
机译: 柔性关节机械臂的分数阶滑模优化控制方法
机译: 机械扶手导向非运动模型轨迹跟踪方法和机械臂系统