CN107942684A - 基于分数阶自适应非奇异终端滑模的机械臂轨迹跟踪方法 - Google Patents
基于分数阶自适应非奇异终端滑模的机械臂轨迹跟踪方法 Download PDFInfo
- Publication number
- CN107942684A CN107942684A CN201711432583.5A CN201711432583A CN107942684A CN 107942684 A CN107942684 A CN 107942684A CN 201711432583 A CN201711432583 A CN 201711432583A CN 107942684 A CN107942684 A CN 107942684A
- Authority
- CN
- China
- Prior art keywords
- mrow
- mover
- msub
- centerdot
- msup
- 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
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B13/00—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion
- G05B13/02—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric
- G05B13/04—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric involving the use of models or simulators
- G05B13/042—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric involving the use of models or simulators in which a parameter or coefficient is automatically adjusted to optimise the performance
Abstract
本发明公开了一种基于分数阶自适应非奇异终端滑模的机械臂轨迹跟踪方法,通过设计对不确定上界的自适应率和分数阶自适应非奇异终端滑模的切换控制,使系统状态更快的收敛到滑模面上,再通过非奇异终端滑模面的滑模特性,使系统状态在有限时间内更快的收敛到平衡点,即跟踪误差收敛到0,从而实现对期望关节角轨迹的跟踪。
Description
技术领域
本发明属于六自由度机器臂轨迹跟踪技术领域,更为具体地讲,涉及一种基于分数阶自适应非奇异终端滑模的机械臂轨迹跟踪方法。
背景技术
随着机器人工业水平的不断提高,机械臂已被广泛应用于自动化领域,如航空航天等大型设备制造检测,医疗手术,工业生产等。但是机械臂的绝对定位精度不能满足一些高精度的自动化生产需求,且机械臂是一个具有非线性、不确定性、未完全建模、交叉耦合等特征的复杂系统,对其进行精确的轨迹跟踪是非常困难的。为了满足更高准确度的轨迹跟踪要求,就必须设计更加精确的控制器以及更具有其适用性的控制方法。
目前被广泛用于非线性复杂系统的滑模控制方法,由于其具有对外界干扰以及参数变化的完全鲁棒性,在机械臂系统中的应用也取得很好的效果。但由于在控制过程中频繁切换控制结构,使控制器的输出出现较大的抖振现象,导致系统不能达到理想滑动模态。基于抖振问题,已有很多先进的方法被提出,例如,边界层法、滑模区域法、趋近率法等,其均能从一定程度上克服或减少抖振,但均以花费更长的响应时间或是跟踪误差较大为代价的。对于高精度要求的多连杆机械臂系统中,响应时间的长短,跟踪误差的大小均是其不可忽略的性能指标。
发明内容
本发明的目的在于克服现有技术的不足,提供一种基于分数阶自适应非奇异终端滑模的机械臂轨迹跟踪方法,在切换控制中设计分数阶指数趋近的自适应滑模控制,使复杂任务以及高精度要求的机械操作中,能够精确地进行轨迹跟踪闭环控制,满足实际情况和工业需求。
为实现上述发明目的,本发明一种基于分数阶自适应非奇异终端滑模的机械臂轨迹跟踪方法,其特征在于,包括以下步骤:
(1)、设期望的六自由度机械臂末端位姿信息为P,P∈R4×4为齐次变换矩阵,由机械臂逆运动学将末端位姿信息P解算为各个关节的期望关节角qd,qd∈R6且qd=[qd1,qd2,...,qd6]T,R6表示6维的实数;
(2)、建立六自由度机械臂的动力学模型:
其中,分别代表六个关节角的角度,角速度和角加速度,M(q)=M0(q)+ΔM(q)∈R6×6为正定惯性矩阵,为科里奥利矩阵,G(q)=G0(q)+ΔG(q)∈R6为重力矩阵,为标称值,ΔM(q),ΔG(q)为系统误差项,τ,τd∈R6分别为驱动力矩和干扰力矩;
设六自由度机械臂的动力学模型的实际关节角输出为q,则关节角的角度跟踪误差为:e=q-qd;
比较角度跟踪误差e与预设阈值ζ的大小,如果e<ζ,则运行结束,否则进入步骤(3);
(3)、根据角度跟踪误差e设计线性滑模面s和非奇异终端滑模面σ
(3.1)、线性滑模面s为:
其中,为e的一阶导,β=diag(β11,β12,...,β1n),diag(·)表示对角矩阵,β11,β12,...,β1n为对角矩阵中的元素;
(3.2)、非奇异终端滑模面σ为:
其中,γ=diag(γ11,γ12,...,γ1n),0<q<p,且为s的一阶导;
(4)、根据线性滑模面s和非奇异终端滑模面σ设计等效控制器u0
对非奇异终端滑模面σ求一阶导,得:
令得到等效控制器u0:
其中,为u0的一阶导;
(5)、设计基于分数阶符号函数的指数趋近的切换控制器u1
其中,为u1的一阶导,为正定对角阵,||·||为欧几里得范数,sgn(·)为符号函数,为分数阶阶次为a的符号函数,且有0≤a<1,为自适应参数,实现对系统误差和外界干扰上界的估计;
(6)、将等效控制器和切换控制器相加并积分,得到最终的控制器τ;
(7)、在控制器τ的控制下,六自由度机械臂的动力学模型输出实际的关节角q*,再利用q*替代假设的q,并返回步骤(2),完成机械臂轨迹跟踪。
本发明的发明目的是这样实现的:
本发明一种基于分数阶自适应非奇异终端滑模的机械臂轨迹跟踪方法,通过设计对不确定上界的自适应率和分数阶自适应非奇异终端滑模的切换控制,使系统状态更快的收敛到滑模面上,再通过非奇异终端滑模面的滑模特性,使系统状态在有限时间内更快的收敛到平衡点,即跟踪误差收敛到0,从而实现对期望关节角轨迹的跟踪。
同时,本发明一种基于分数阶自适应非奇异终端滑模的机械臂轨迹跟踪方法还具有以下有益效果:
(1)、针对抖振现象,本发明采用积分器对控制器的输出进行积分,将不连续的控制信号转化为连续信号,实现实际控制信号的平滑和无振动;
(2)、本发明对滑模控制算法进行了改进,设计一个分数阶滑模控制算法,在切换控制中引入了分数阶指数趋近律,加快了向滑模面的趋近速度,提高了效率;其次,引入分数阶次扩大了系统的性能调节范围,具有更好的适应性;
(3)、本发明针对被控机械臂系统的建模失配和外界干扰,引入了自适应法则,对系统的不确定性上界进行估计,从而有效解决了在没有先验知识的前提下,对不确定性的抑制问题,提高了系统的鲁棒性;
(4)、本发明采用了非奇异终端滑模面,能够有效避免滑模的奇异问题,而且能够保证系统状态可以在有限时间内快速的收敛到平衡点,即跟踪误差为0,实现机械臂关节角的精确跟踪。
附图说明
图1是本发明基于分数阶自适应非奇异终端滑模的机械臂轨迹跟踪方法流程图;
图2是机械臂六个关节角的跟踪曲线(分数阶次a=0.3);
图3是机械臂六个关节角的跟踪误差曲线(分数阶次a=0.3);
图4是自适应参数随时间的变化曲线(分数阶次a=0.3);
图5是机械臂六个关节处的实际控制值(分数阶次a=0.3);
图6是控制方法在不同分数阶阶次下滑模变量随时间的变化曲线(分数阶次a=0.3和0.5);
图7是控制方法在不同分数阶阶次下控制器的输出曲线(分数阶次a=0.3和0.5)。
具体实施方式
下面结合附图对本发明的具体实施方式进行描述,以便本领域的技术人员更好地理解本发明。需要特别提醒注意的是,在以下的描述中,当已知功能和设计的详细描述也许会淡化本发明的主要内容时,这些描述在这里将被忽略。
实施例
图1是本发明基于分数阶自适应非奇异终端滑模的机械臂轨迹跟踪方法流程图。
在本实施例中,将本发明应用于六自由度机械臂的控制,即对机械臂的六个关节角进行轨迹跟踪。下面结合图1,对本发明一种基于分数阶自适应非奇异终端滑模的机械臂轨迹跟踪方法进行详细说明,具体包括以下步骤:
S1、针对具体的任务需求,设期望的六自由度机械臂末端位姿序列信息为P,P∈R4 ×4为齐次变换矩阵,由机械臂逆运动学将末端位姿信息P解算为各个关节的期望关节角qd,qd∈R6且qd=[qd1,qd2,...,qd6]T,R6表示6维的实数;
S2、建立六自由度机械臂的动力学模型:
其中,分别代表六个关节角的角度,角速度和角加速度,M(q)=M0(q)+ΔM(q)∈R6×6为正定惯性矩阵,为科里奥利矩阵,G(q)=G0(q)+ΔG(q)∈R6为重力矩阵,M0(q),G0(q)为标称值,ΔM(q),ΔG(q)为系统误差项,τ,τd∈R6分别为驱动力矩和干扰力矩;
设六自由度机械臂的动力学模型的实际关节角输出为q,则关节角的角度跟踪误差为:e=q-qd;
比较角度跟踪误差e与预设阈值ζ的大小,如果e<ζ,则运行结束,否则进入步骤S3;
S3、根据角度跟踪误差e设计线性滑模面s和非奇异终端滑模面σ
S3.1、线性滑模面s为:
其中,为e的一阶导,β=diag(β11,β12,...,β1n),diag(·)表示对角矩阵,β11,β12,...,β1n为对角矩阵中的元素;
S3.2、非奇异终端滑模面σ为:
其中,γ=diag(γ11,γ12,...,γ1n),0<q<p,且为s的一阶导;
在本实施例中,采用了非奇异终端滑模面,能够有效避免滑模的奇异问题,而且能够保证系统状态可以在有限时间内快速的收敛到平衡点,即跟踪误差为0,实现机械臂关节角的精确跟踪。
S4、根据线性滑模面s和非奇异终端滑模面σ设计等效控制器u0
对非奇异终端滑模面σ求一阶导,得:
令得到等效控制器u0:
其中,为u0的一阶导;
S5、设计基于分数阶符号函数的指数趋近律的切换控制器u1
其中,为u1的一阶导,为正定对角阵,||·||为欧几里得范数,sgn(·)为符号函数,为分数阶阶次为a的符号函数,且有0≤a<1,为自适应参数,实现对系统误差和外界干扰上界的估计;
切换控制器分为3个部分,第一项用于克服建模失配和外界干扰对控制的影响,从而有效解决了在没有先验知识的前提下,对不确定性的抑制问题,提高了系统的鲁棒性;第二项和第三项为滑模面的指数趋近律,其中第二项可使系统状态从初始态向滑模面运动,第三项可以实现系统状态从初始态到滑模面的指数趋近。
这里我们针对传统的指数趋近律进行了扩展,即将第二项由整数阶扩展到分数阶,且该分数阶符号函数具有以下性质:
通过调整不同的分数阶阶次a,实现对切换控制趋近率的不同的控制,提升切换控制的控制效果。
下面我们对自适应参数的确定方法进行说明,具体为:
考虑到在实际工程中,滑模面σ可能在有限时间里不能精确为零以及自适应参数可能增加到无界的情况,利用死区技术对非奇异终端滑模面的范数||σ||=0的[0,+ε)邻域进行处理,处理后的自适应参数为:
其中,ρ0,ρ1,ρ2为正的可调参数,ε为一个很小的正常数。
这样通过在切换控制中引入了分数阶指数趋近律,加快了误差的收敛速度,提高了效率;其次,引入分数阶次扩大了系统的性能调节范围,具有更好的适应性。
S6、将等效控制器和切换控制器相加并积分,得到最终的控制器τ;
在本实施例中,采用积分器对控制器的输出进行积分,将不连续的控制信号转化为连续信号,实现实际控制信号的平滑和无振动。
S7、在控制器τ的控制下,六自由度机械臂的动力学模型输出实际的关节角q*,再利用q*替代假设的q,并返回步骤S2,经过闭环反馈,最终跟踪到期望的关节角轨迹。
实例
在本实例中,我们首先对本发明所提出的分数阶自适应终端滑模控制器的可行性进行验证,然后对不同的分数阶次进行对比分析,下面对仿真中用到的参数进行说明。
设六自由度机械臂系统内部有十二个状态x∈R12且
期望的各关节角的轨迹为:
qd1=3.25-(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,5,6),q3(0)=3,
外部干扰项为:τdi=0.02sin(t),i=1,3,4,5,6,τd2=0.1cos(2t)。
针对本发明所提出的控制器,参数选取为:
β=diag(30,30,30,30,30,30),γ=diag(0.002,0.002,0.002,0.002,0.002,0.002),p=15,q=13。自适应参数:ρ0=3,ρ1=4,ρ2=6,ε=0.002。初始值
切换控制中参数的选取:
将上述参数加到所提出的控制器及仿真模型中,得到下面的仿真结果。这里切换控制中分数阶的阶次选取a=0.3,并且进行控制方法可行性的验证。
图2所示为机械臂六个关节角的跟踪曲线,其中qdi,(i=1,...,6)为期望的关节角轨迹,qi,(i=1,...,6)为实际跟踪曲线。在外界干扰存在的情况下,由图中可以看出提出的控制方法可以使实际关节角有效的跟踪到期望值。
图3所示为机械臂六个关节角的跟踪误差,且该误差都能在有限时间内收敛到0,从而体现了该控制方法的有效性,即使系统状态在有限时间内收敛到系统的平衡点。
图4所示为自适应参数随时间的变化曲线,由图可以看出,该自适应参数在一段时间后不再增长,体现了滑模变量到达滑模面附近时死区技术的作用,同时该自适应法则可以对系统的不确定性上界进行估计,从而有效抑制了外界干扰和建模失配对控制性能的影响。
图5所示为六自由度机械臂各个关节处的控制值τ,每个分量记为τi,i=1,...,6。由图中可以看出,6个控制分量在经过积分作用后,有效减小了由切换控制带来的抖震问题,提高了控制的性能。
接下来针对本发明所提出的控制方法,进行不同分数阶次a=0.3和0.5的对比分析。保持上述控制方法和机械臂模型参数不变,只修改切换控制中分数阶的阶次,得到如下的仿真结果。
图6所示为不同分数阶阶次下滑模变量随时间的变化曲线(以第一个分量σ1为例),由图中可以看出在控制器选择不同的分数阶阶次时,该滑模面的的抖动程度有明显不同,且随着分数阶阶次的减小,滑模面的抖动会变小。
图7所示为不同分数阶阶次下控制器的输出曲线(以第一关节的控制量τ1为例),由图中可以看出随着分数阶阶次的减小,由切换控制带来的控制器抖震会变小。实际工程中可灵活选取分数阶阶次已达到最好的控制效果,从而体现了本发明控制方法不同分数阶阶次的适应性。
尽管上面对本发明说明性的具体实施方式进行了描述,以便于本技术领域的技术人员理解本发明,但应该清楚,本发明不限于具体实施方式的范围,对本技术领域的普通技术人员来讲,只要各种变化在所附的权利要求限定和确定的本发明的精神和范围内,这些变化是显而易见的,一切利用本发明构思的发明创造均在保护之列。
Claims (3)
1.一种基于分数阶自适应非奇异终端滑模的机械臂轨迹跟踪方法,其特征在于,包括以下步骤:
(1)、设期望的六自由度机械臂末端位姿信息为P,P∈R4×4为齐次变换矩阵,由机械臂逆运动学将末端位姿信息P解算为各个关节的期望关节角qd,qd∈R6且qd=[qd1,qd2,...,qd6]T,R6表示6维的实数;
(2)、建立六自由度机械臂的动力学模型:
其中,q,分别代表六个关节角的角度,角速度和角加速度,M(q)=M0(q)+ΔM(q)∈R6×6为正定惯性矩阵,为科里奥利矩阵,G(q)=G0(q)+ΔG(q)∈R6为重力矩阵,M0(q),G0(q)为标称值,ΔM(q),ΔG(q)为系统误差项,τ,τd∈R6分别为驱动力矩和干扰力矩;
设六自由度机械臂的动力学模型的实际关节角输出为q,则关节角的角度跟踪误差为:e=q-qd;
比较角度跟踪误差e与预设阈值ζ的大小,如果,则运行结束,否则进入步骤(3);
(3)、根据角度跟踪误差e设计线性滑模面s和非奇异终端滑模面σ
(3.1)、线性滑模面s为:
<mrow>
<mi>s</mi>
<mo>=</mo>
<mover>
<mi>e</mi>
<mo>&CenterDot;</mo>
</mover>
<mo>+</mo>
<mi>&beta;</mi>
<mi>e</mi>
<mo>,</mo>
</mrow>
其中,为e的一阶导,β=diag(β11,β12,...,β1n),diag(·)表示对角矩阵,β11,β12,...,β1n为对角矩阵中的元素;
(3.2)、非奇异终端滑模面σ为:
<mrow>
<mi>&sigma;</mi>
<mo>=</mo>
<mi>s</mi>
<mo>+</mo>
<mi>&gamma;</mi>
<msup>
<mover>
<mi>s</mi>
<mo>&CenterDot;</mo>
</mover>
<mrow>
<mi>p</mi>
<mo>/</mo>
<mi>q</mi>
</mrow>
</msup>
</mrow>
其中,γ=diag(γ11,γ12,...,γ1n),0<q<p,且 为s的一阶导;
(4)、根据线性滑模面s和非奇异终端滑模面σ设计等效控制器u0
对非奇异终端滑模面σ求一阶导,得:
<mrow>
<mover>
<mi>&sigma;</mi>
<mo>&CenterDot;</mo>
</mover>
<mo>=</mo>
<mover>
<mi>s</mi>
<mo>&CenterDot;</mo>
</mover>
<mo>+</mo>
<mi>&gamma;</mi>
<mfrac>
<mi>p</mi>
<mi>q</mi>
</mfrac>
<msup>
<mover>
<mi>s</mi>
<mo>&CenterDot;</mo>
</mover>
<mrow>
<mi>p</mi>
<mo>/</mo>
<mi>q</mi>
<mo>-</mo>
<mn>1</mn>
</mrow>
</msup>
<mover>
<mi>s</mi>
<mo>&CenterDot;&CenterDot;</mo>
</mover>
<mo>=</mo>
<mi>&gamma;</mi>
<mfrac>
<mi>p</mi>
<mi>q</mi>
</mfrac>
<msup>
<mover>
<mi>s</mi>
<mo>&CenterDot;</mo>
</mover>
<mrow>
<mi>p</mi>
<mo>/</mo>
<mi>q</mi>
<mo>-</mo>
<mn>1</mn>
</mrow>
</msup>
<mrow>
<mo>(</mo>
<mover>
<mi>s</mi>
<mo>&CenterDot;&CenterDot;</mo>
</mover>
<mo>+</mo>
<msup>
<mi>&gamma;</mi>
<mrow>
<mo>-</mo>
<mn>1</mn>
</mrow>
</msup>
<msup>
<mrow>
<mo>(</mo>
<mfrac>
<mi>p</mi>
<mi>q</mi>
</mfrac>
<mo>)</mo>
</mrow>
<mrow>
<mo>-</mo>
<mn>1</mn>
</mrow>
</msup>
<msup>
<mover>
<mi>s</mi>
<mo>&CenterDot;</mo>
</mover>
<mrow>
<mn>2</mn>
<mo>-</mo>
<mi>p</mi>
<mo>/</mo>
<mi>q</mi>
</mrow>
</msup>
<mo>)</mo>
</mrow>
</mrow>
令得到等效控制器u0:
<mfenced open = "" close = "">
<mtable>
<mtr>
<mtd>
<mrow>
<msub>
<mover>
<mi>u</mi>
<mo>&CenterDot;</mo>
</mover>
<mn>0</mn>
</msub>
<mo>=</mo>
<mfrac>
<mi>d</mi>
<mrow>
<mi>d</mi>
<mi>t</mi>
</mrow>
</mfrac>
<mo>&lsqb;</mo>
<msub>
<mi>C</mi>
<mn>0</mn>
</msub>
<mrow>
<mo>(</mo>
<mi>q</mi>
<mo>,</mo>
<mover>
<mi>q</mi>
<mo>&CenterDot;</mo>
</mover>
<mo>)</mo>
</mrow>
<mover>
<mi>q</mi>
<mo>&CenterDot;</mo>
</mover>
<mo>+</mo>
<msub>
<mi>G</mi>
<mn>0</mn>
</msub>
<mrow>
<mo>(</mo>
<mi>q</mi>
<mo>)</mo>
</mrow>
<mo>&rsqb;</mo>
<mo>-</mo>
<msub>
<mi>M</mi>
<mn>0</mn>
</msub>
<mrow>
<mo>(</mo>
<mi>q</mi>
<mo>)</mo>
</mrow>
<mo>&lsqb;</mo>
<msup>
<msub>
<mover>
<mi>M</mi>
<mo>&CenterDot;</mo>
</mover>
<mn>0</mn>
</msub>
<mrow>
<mo>-</mo>
<mn>1</mn>
</mrow>
</msup>
<mrow>
<mo>(</mo>
<mi>q</mi>
<mo>)</mo>
</mrow>
<mrow>
<mo>(</mo>
<mi>&tau;</mi>
<mo>-</mo>
<msub>
<mi>C</mi>
<mn>0</mn>
</msub>
<mo>(</mo>
<mrow>
<mi>q</mi>
<mo>,</mo>
<mover>
<mi>q</mi>
<mo>&CenterDot;</mo>
</mover>
</mrow>
<mo>)</mo>
<mover>
<mi>q</mi>
<mo>&CenterDot;</mo>
</mover>
<mo>-</mo>
<msub>
<mi>G</mi>
<mn>0</mn>
</msub>
<mo>(</mo>
<mi>q</mi>
<mo>)</mo>
<mo>)</mo>
</mrow>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<mo>-</mo>
<mfrac>
<mi>d</mi>
<mrow>
<mi>d</mi>
<mi>t</mi>
</mrow>
</mfrac>
<msub>
<mover>
<mi>q</mi>
<mo>&CenterDot;&CenterDot;</mo>
</mover>
<mi>d</mi>
</msub>
<mo>+</mo>
<mi>&beta;</mi>
<mover>
<mi>e</mi>
<mo>&CenterDot;&CenterDot;</mo>
</mover>
<mo>+</mo>
<msup>
<mi>&gamma;</mi>
<mrow>
<mo>-</mo>
<mn>1</mn>
</mrow>
</msup>
<msup>
<mrow>
<mo>(</mo>
<mfrac>
<mi>p</mi>
<mi>q</mi>
</mfrac>
<mo>)</mo>
</mrow>
<mrow>
<mo>-</mo>
<mn>1</mn>
</mrow>
</msup>
<msup>
<mover>
<mi>s</mi>
<mo>&CenterDot;</mo>
</mover>
<mrow>
<mn>2</mn>
<mo>-</mo>
<mi>p</mi>
<mo>/</mo>
<mi>q</mi>
</mrow>
</msup>
<mo>&rsqb;</mo>
</mrow>
</mtd>
</mtr>
</mtable>
</mfenced>
其中,为u0的一阶导;
(5)、设计基于分数阶符号函数的指数趋近的切换控制器u1
其中,为u1的一阶导,为正定对角阵,||·||为欧几里得范数,sgn(·)为符号函数,为分数阶阶次为a的符号函数,且有0≤a<1,为自适应参数,实现对系统误差和外界干扰上界的估计;
(6)、将等效控制器和切换控制器相加并积分,得到最终的控制器τ;
<mrow>
<mi>&tau;</mi>
<mo>=</mo>
<msubsup>
<mo>&Integral;</mo>
<mn>0</mn>
<mi>t</mi>
</msubsup>
<mrow>
<mo>(</mo>
<msub>
<mover>
<mi>u</mi>
<mo>&CenterDot;</mo>
</mover>
<mn>0</mn>
</msub>
<mo>+</mo>
<msub>
<mover>
<mi>u</mi>
<mo>&CenterDot;</mo>
</mover>
<mn>1</mn>
</msub>
<mo>)</mo>
</mrow>
<mi>d</mi>
<mi>t</mi>
</mrow>
(7)、在控制器τ的控制下,六自由度机械臂的动力学模型输出实际的关节角q*,再利用q*替代假设的q,并返回步骤(2),完成机械臂轨迹跟踪。
2.根据权利要求1所述的基于分数阶自适应非奇异终端滑模的机械臂轨迹跟踪方法,其特征在于,所述的分数阶阶次为a的符号函数满足条件:
3.根据权利要求1所述的基于分数阶自适应非奇异终端滑模的机械臂轨迹跟踪方法,其特征在于,所述的自适应参数的确定方法为:
利用死区技术对非奇异终端滑模面的范数||σ||=0的[0,+ε)邻域进行处理,处理后的自适应参数为:
<mrow>
<msub>
<mover>
<mover>
<mover>
<mi>B</mi>
<mo>&OverBar;</mo>
</mover>
<mo>^</mo>
</mover>
<mo>&CenterDot;</mo>
</mover>
<mn>0</mn>
</msub>
<mo>=</mo>
<mfenced open = "{" close = "">
<mtable>
<mtr>
<mtd>
<mrow>
<msub>
<mi>&rho;</mi>
<mn>0</mn>
</msub>
<mrow>
<mo>(</mo>
<mfrac>
<mi>p</mi>
<mi>q</mi>
</mfrac>
<mo>)</mo>
</mrow>
<mo>|</mo>
<mo>|</mo>
<mi>&gamma;</mi>
<mo>|</mo>
<mo>|</mo>
<mo>|</mo>
<mo>|</mo>
<msup>
<mover>
<mi>s</mi>
<mo>&CenterDot;</mo>
</mover>
<mrow>
<mo>(</mo>
<mi>p</mi>
<mo>/</mo>
<mi>q</mi>
<mo>)</mo>
<mo>-</mo>
<mn>1</mn>
</mrow>
</msup>
<mi>&sigma;</mi>
<mo>|</mo>
<mo>|</mo>
<mo>,</mo>
</mrow>
</mtd>
<mtd>
<mrow>
<mo>|</mo>
<mo>|</mo>
<mi>&sigma;</mi>
<mo>|</mo>
<mo>|</mo>
<mo>&GreaterEqual;</mo>
<mi>&epsiv;</mi>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<mn>0</mn>
<mo>,</mo>
</mrow>
</mtd>
<mtd>
<mrow>
<mo>|</mo>
<mo>|</mo>
<mi>&sigma;</mi>
<mo>|</mo>
<mo>|</mo>
<mo><</mo>
<mi>&epsiv;</mi>
</mrow>
</mtd>
</mtr>
</mtable>
</mfenced>
</mrow>
<mrow>
<msub>
<mover>
<mover>
<mover>
<mi>B</mi>
<mo>&OverBar;</mo>
</mover>
<mo>^</mo>
</mover>
<mo>&CenterDot;</mo>
</mover>
<mn>1</mn>
</msub>
<mo>=</mo>
<mfenced open = "{" close = "">
<mtable>
<mtr>
<mtd>
<mrow>
<msub>
<mi>&rho;</mi>
<mn>1</mn>
</msub>
<mrow>
<mo>(</mo>
<mfrac>
<mi>p</mi>
<mi>q</mi>
</mfrac>
<mo>)</mo>
</mrow>
<mo>|</mo>
<mo>|</mo>
<mi>&gamma;</mi>
<mo>|</mo>
<mo>|</mo>
<mo>|</mo>
<mo>|</mo>
<msup>
<mover>
<mi>s</mi>
<mo>&CenterDot;</mo>
</mover>
<mrow>
<mo>(</mo>
<mi>p</mi>
<mo>/</mo>
<mi>q</mi>
<mo>)</mo>
<mo>-</mo>
<mn>1</mn>
</mrow>
</msup>
<mi>&sigma;</mi>
<mo>|</mo>
<mo>|</mo>
<mo>|</mo>
<mo>|</mo>
<mi>q</mi>
<mo>|</mo>
<mo>|</mo>
<mo>,</mo>
</mrow>
</mtd>
<mtd>
<mrow>
<mo>|</mo>
<mo>|</mo>
<mi>&sigma;</mi>
<mo>|</mo>
<mo>|</mo>
<mo>&GreaterEqual;</mo>
<mi>&epsiv;</mi>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<mn>0</mn>
<mo>,</mo>
</mrow>
</mtd>
<mtd>
<mrow>
<mo>|</mo>
<mo>|</mo>
<mi>&sigma;</mi>
<mo>|</mo>
<mo>|</mo>
<mo><</mo>
<mi>&epsiv;</mi>
</mrow>
</mtd>
</mtr>
</mtable>
</mfenced>
</mrow>
<mrow>
<msub>
<mover>
<mover>
<mover>
<mi>B</mi>
<mo>&OverBar;</mo>
</mover>
<mo>^</mo>
</mover>
<mo>&CenterDot;</mo>
</mover>
<mn>2</mn>
</msub>
<mo>=</mo>
<mfenced open = "{" close = "">
<mtable>
<mtr>
<mtd>
<mrow>
<msub>
<mi>&rho;</mi>
<mn>2</mn>
</msub>
<mrow>
<mo>(</mo>
<mfrac>
<mi>p</mi>
<mi>q</mi>
</mfrac>
<mo>)</mo>
</mrow>
<mo>|</mo>
<mo>|</mo>
<mi>&gamma;</mi>
<mo>|</mo>
<mo>|</mo>
<mo>|</mo>
<mo>|</mo>
<msup>
<mover>
<mi>s</mi>
<mo>&CenterDot;</mo>
</mover>
<mrow>
<mo>(</mo>
<mi>p</mi>
<mo>/</mo>
<mi>q</mi>
<mo>)</mo>
<mo>-</mo>
<mn>1</mn>
</mrow>
</msup>
<mi>&sigma;</mi>
<mo>|</mo>
<mo>|</mo>
<mo>|</mo>
<mo>|</mo>
<mover>
<mi>q</mi>
<mo>&CenterDot;</mo>
</mover>
<mo>|</mo>
<msup>
<mo>|</mo>
<mn>2</mn>
</msup>
<mo>,</mo>
</mrow>
</mtd>
<mtd>
<mrow>
<mo>|</mo>
<mo>|</mo>
<mi>&sigma;</mi>
<mo>|</mo>
<mo>|</mo>
<mo>&GreaterEqual;</mo>
<mi>&epsiv;</mi>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<mn>0</mn>
<mo>,</mo>
</mrow>
</mtd>
<mtd>
<mrow>
<mo>|</mo>
<mo>|</mo>
<mi>&sigma;</mi>
<mo>|</mo>
<mo>|</mo>
<mo><</mo>
<mi>&epsiv;</mi>
</mrow>
</mtd>
</mtr>
</mtable>
</mfenced>
</mrow>
其中,ρ0,ρ1,ρ2为正的可调参数,ε为一个很小的正常数。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201711432583.5A CN107942684B (zh) | 2017-12-26 | 2017-12-26 | 基于分数阶自适应非奇异终端滑模的机械臂轨迹跟踪方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201711432583.5A CN107942684B (zh) | 2017-12-26 | 2017-12-26 | 基于分数阶自适应非奇异终端滑模的机械臂轨迹跟踪方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN107942684A true CN107942684A (zh) | 2018-04-20 |
CN107942684B CN107942684B (zh) | 2020-03-24 |
Family
ID=61939195
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201711432583.5A Active CN107942684B (zh) | 2017-12-26 | 2017-12-26 | 基于分数阶自适应非奇异终端滑模的机械臂轨迹跟踪方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN107942684B (zh) |
Cited By (18)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN108646561A (zh) * | 2018-05-15 | 2018-10-12 | 浙江工业大学 | 一种基于交叉耦合的多机械臂系统固定时间参数辨识与位置同步控制方法 |
CN108646563A (zh) * | 2018-05-15 | 2018-10-12 | 浙江工业大学 | 一种基于均值耦合的多机械臂系统固定时间参数辨识与位置同步控制方法 |
CN108646562A (zh) * | 2018-05-15 | 2018-10-12 | 浙江工业大学 | 一种基于交叉耦合的多机械臂系统有限时间参数辨识与位置同步控制方法 |
CN108683370A (zh) * | 2018-06-26 | 2018-10-19 | 电子科技大学 | 一种基于自适应滑模观测器的无刷直流电机转矩控制方法 |
CN108803326A (zh) * | 2018-06-06 | 2018-11-13 | 黄山学院 | 具有干扰和时延的工业机械臂线性自抗扰跟踪控制方法 |
CN108983606A (zh) * | 2018-07-09 | 2018-12-11 | 南京理工大学 | 一种机械臂系统的鲁棒滑模自适应控制方法 |
CN109557816A (zh) * | 2018-12-28 | 2019-04-02 | 武汉工程大学 | 一种压电陶瓷执行器迟滞特性的抑制方法、系统及介质 |
CN110161852A (zh) * | 2019-05-08 | 2019-08-23 | 杭州电子科技大学 | 一种基于二阶滑模算法的移动机械臂运动控制方法 |
CN110262255A (zh) * | 2019-07-16 | 2019-09-20 | 东南大学 | 一种基于自适应终端滑模控制器的机械臂轨迹跟踪控制方法 |
CN110405758A (zh) * | 2019-07-15 | 2019-11-05 | 西北工业大学 | 基于非奇异终端滑模技术的空间机器人目标抓捕控制方法 |
CN110653825A (zh) * | 2019-10-17 | 2020-01-07 | 徐龙 | 一种基于全阶滑模的六自由度机械臂控制方法 |
CN111673742A (zh) * | 2020-05-22 | 2020-09-18 | 江苏信息职业技术学院 | 一种工业机器人轨迹跟踪控制算法 |
CN112241124A (zh) * | 2020-10-27 | 2021-01-19 | 南昌大学 | 一种自适应反演积分非奇异快速终端滑模控制器设计方法 |
CN112859600A (zh) * | 2021-01-08 | 2021-05-28 | 航天时代飞鸿技术有限公司 | 一种基于扩张状态观测器的机械系统有限时间控制方法 |
CN113625573A (zh) * | 2021-09-18 | 2021-11-09 | 金陵科技学院 | 受非对称死区输入影响的分数阶系统反步滑模控制方法 |
CN114571451A (zh) * | 2022-02-25 | 2022-06-03 | 山东新一代信息产业技术研究院有限公司 | 一种可调漏斗边界的自适应滑模控制方法及设备 |
CN115453890A (zh) * | 2022-10-27 | 2022-12-09 | 南京师范大学泰州学院 | 一种齿轮巡检机器人系统全局非奇异终端滑模控制方法 |
CN115685732A (zh) * | 2022-10-27 | 2023-02-03 | 南京师范大学泰州学院 | 一种齿轮巡检机器人系统分数阶非线性pd滑模控制方法 |
Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN106374488A (zh) * | 2016-09-13 | 2017-02-01 | 河海大学常州校区 | 基于分数阶终端滑模的有源电力滤波器afnn控制方法 |
CN106393116A (zh) * | 2016-11-18 | 2017-02-15 | 山东大学 | 具有初态学习的机械臂分数阶迭代学习控制方法及系统 |
CN106527152A (zh) * | 2017-01-09 | 2017-03-22 | 山东大学 | 闭环分数阶PDɑ型迭代学习机器人控制器的设计方法及系统 |
CN107457783A (zh) * | 2017-07-25 | 2017-12-12 | 电子科技大学 | 基于pd控制器的六自由度机械臂自适应智能检测方法 |
-
2017
- 2017-12-26 CN CN201711432583.5A patent/CN107942684B/zh active Active
Patent Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN106374488A (zh) * | 2016-09-13 | 2017-02-01 | 河海大学常州校区 | 基于分数阶终端滑模的有源电力滤波器afnn控制方法 |
CN106393116A (zh) * | 2016-11-18 | 2017-02-15 | 山东大学 | 具有初态学习的机械臂分数阶迭代学习控制方法及系统 |
CN106527152A (zh) * | 2017-01-09 | 2017-03-22 | 山东大学 | 闭环分数阶PDɑ型迭代学习机器人控制器的设计方法及系统 |
CN107457783A (zh) * | 2017-07-25 | 2017-12-12 | 电子科技大学 | 基于pd控制器的六自由度机械臂自适应智能检测方法 |
Non-Patent Citations (5)
Title |
---|
YIN CHUN, ET AL.: "Adaptive fractional-order switching-type control method design for 3D fractional-order nonlinear systems", 《NONLINEAR DYNAMICS》 * |
YIN CHUN,ET AL.: "Fractional-order power rate type reaching law for sliding mode control of uncertain nonlinear system", 《IFAC PROCEEDINGS VOLUMES》 * |
YIN CHUN,ET AL.: "Fractional-order switching type control law design for adaptive sliding mode technique of 3D fractional-order nonlinear systems", 《COMPLEXITY》 * |
徐杰 等: "基于改进趋近律的机械臂非奇异终端滑模控制", 《黑龙江科技大学学报》 * |
赵霞 等: "基于多模态滑模的快速非奇异终端滑模控制", 《基于多模态滑模的快速非奇异终端滑模控制》 * |
Cited By (31)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN108646563B (zh) * | 2018-05-15 | 2020-12-01 | 浙江工业大学 | 一种基于均值耦合的多机械臂系统固定时间参数辨识与位置同步控制方法 |
CN108646563A (zh) * | 2018-05-15 | 2018-10-12 | 浙江工业大学 | 一种基于均值耦合的多机械臂系统固定时间参数辨识与位置同步控制方法 |
CN108646562A (zh) * | 2018-05-15 | 2018-10-12 | 浙江工业大学 | 一种基于交叉耦合的多机械臂系统有限时间参数辨识与位置同步控制方法 |
CN108646561A (zh) * | 2018-05-15 | 2018-10-12 | 浙江工业大学 | 一种基于交叉耦合的多机械臂系统固定时间参数辨识与位置同步控制方法 |
CN108803326A (zh) * | 2018-06-06 | 2018-11-13 | 黄山学院 | 具有干扰和时延的工业机械臂线性自抗扰跟踪控制方法 |
CN108803326B (zh) * | 2018-06-06 | 2021-04-23 | 黄山学院 | 具有干扰和时延的工业机械臂线性自抗扰跟踪控制方法 |
CN108683370A (zh) * | 2018-06-26 | 2018-10-19 | 电子科技大学 | 一种基于自适应滑模观测器的无刷直流电机转矩控制方法 |
CN108983606A (zh) * | 2018-07-09 | 2018-12-11 | 南京理工大学 | 一种机械臂系统的鲁棒滑模自适应控制方法 |
CN108983606B (zh) * | 2018-07-09 | 2021-04-27 | 南京理工大学 | 一种机械臂系统的鲁棒滑模自适应控制方法 |
CN109557816A (zh) * | 2018-12-28 | 2019-04-02 | 武汉工程大学 | 一种压电陶瓷执行器迟滞特性的抑制方法、系统及介质 |
CN109557816B (zh) * | 2018-12-28 | 2021-06-29 | 武汉工程大学 | 一种压电陶瓷执行器迟滞特性的抑制方法、系统及介质 |
CN110161852A (zh) * | 2019-05-08 | 2019-08-23 | 杭州电子科技大学 | 一种基于二阶滑模算法的移动机械臂运动控制方法 |
CN110161852B (zh) * | 2019-05-08 | 2022-01-04 | 杭州电子科技大学 | 一种基于二阶滑模算法的移动机械臂运动控制方法 |
CN110405758A (zh) * | 2019-07-15 | 2019-11-05 | 西北工业大学 | 基于非奇异终端滑模技术的空间机器人目标抓捕控制方法 |
CN110405758B (zh) * | 2019-07-15 | 2022-08-09 | 西北工业大学 | 基于非奇异终端滑模技术的空间机器人目标抓捕控制方法 |
CN110262255B (zh) * | 2019-07-16 | 2022-06-14 | 东南大学 | 一种基于自适应终端滑模控制器的机械臂轨迹跟踪控制方法 |
CN110262255A (zh) * | 2019-07-16 | 2019-09-20 | 东南大学 | 一种基于自适应终端滑模控制器的机械臂轨迹跟踪控制方法 |
CN110653825A (zh) * | 2019-10-17 | 2020-01-07 | 徐龙 | 一种基于全阶滑模的六自由度机械臂控制方法 |
CN111673742A (zh) * | 2020-05-22 | 2020-09-18 | 江苏信息职业技术学院 | 一种工业机器人轨迹跟踪控制算法 |
CN112241124A (zh) * | 2020-10-27 | 2021-01-19 | 南昌大学 | 一种自适应反演积分非奇异快速终端滑模控制器设计方法 |
CN112241124B (zh) * | 2020-10-27 | 2022-02-11 | 南昌大学 | 一种自适应反演积分非奇异快速终端滑模控制器设计方法 |
CN112859600A (zh) * | 2021-01-08 | 2021-05-28 | 航天时代飞鸿技术有限公司 | 一种基于扩张状态观测器的机械系统有限时间控制方法 |
CN112859600B (zh) * | 2021-01-08 | 2024-02-09 | 航天时代飞鸿技术有限公司 | 一种基于扩张状态观测器的机械系统有限时间控制方法 |
CN113625573A (zh) * | 2021-09-18 | 2021-11-09 | 金陵科技学院 | 受非对称死区输入影响的分数阶系统反步滑模控制方法 |
CN113625573B (zh) * | 2021-09-18 | 2023-06-30 | 金陵科技学院 | 受非对称死区输入影响的分数阶系统反步滑模控制方法 |
CN114571451A (zh) * | 2022-02-25 | 2022-06-03 | 山东新一代信息产业技术研究院有限公司 | 一种可调漏斗边界的自适应滑模控制方法及设备 |
CN114571451B (zh) * | 2022-02-25 | 2023-08-22 | 山东新一代信息产业技术研究院有限公司 | 一种可调漏斗边界的自适应滑模控制方法及设备 |
CN115453890A (zh) * | 2022-10-27 | 2022-12-09 | 南京师范大学泰州学院 | 一种齿轮巡检机器人系统全局非奇异终端滑模控制方法 |
CN115685732A (zh) * | 2022-10-27 | 2023-02-03 | 南京师范大学泰州学院 | 一种齿轮巡检机器人系统分数阶非线性pd滑模控制方法 |
CN115453890B (zh) * | 2022-10-27 | 2023-08-18 | 南京师范大学泰州学院 | 一种齿轮巡检机器人系统全局非奇异终端滑模控制方法 |
CN115685732B (zh) * | 2022-10-27 | 2023-10-13 | 南京师范大学泰州学院 | 一种齿轮巡检机器人系统分数阶非线性pd滑模控制方法 |
Also Published As
Publication number | Publication date |
---|---|
CN107942684B (zh) | 2020-03-24 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN107942684A (zh) | 基于分数阶自适应非奇异终端滑模的机械臂轨迹跟踪方法 | |
CN107870570A (zh) | 基于分数阶幂次趋近律的终端滑模机械臂轨迹跟踪方法 | |
Boukens et al. | Robust adaptive neural network-based trajectory tracking control approach for nonholonomic electrically driven mobile robots | |
CN107577144B (zh) | 一种基于增强型指数趋近律的飞行器有限时间自适应姿态控制方法 | |
Li et al. | Adaptive RBFNNs/integral sliding mode control for a quadrotor aircraft | |
CN106393116B (zh) | 具有初态学习的机械臂分数阶迭代学习控制方法及系统 | |
Brescianini et al. | Tilt-prioritized quadrocopter attitude control | |
Zuo et al. | $\mathcal {L} _ {1} $ Adaptive Backstepping for Robust Trajectory Tracking of UAVs | |
CN104932271B (zh) | 一种机械臂伺服系统的神经网络全阶滑模控制方法 | |
CN107490966A (zh) | 一种基于改进幂次趋近律的飞行器有限时间自适应姿态控制方法 | |
CN105319972A (zh) | 基于快速终端滑模的遥操作机器人固定时间控制方法 | |
CN108803326A (zh) | 具有干扰和时延的工业机械臂线性自抗扰跟踪控制方法 | |
CN107703952A (zh) | 一种刚性飞行器的非奇异固定时间自适应姿态控制方法 | |
CN105182745B (zh) | 一种带有死区补偿的机械臂伺服系统神经网络全阶滑模控制方法 | |
CN108303885A (zh) | 一种基于干扰观测器的电机位置伺服系统自适应控制方法 | |
Rehman et al. | Motion synchronization in a dual redundant HA/EHA system by using a hybrid integrated intelligent control design | |
CN105700348B (zh) | 一种基于扰动上界估计的电动转台位置跟踪控制方法 | |
CN109164823A (zh) | 一种考虑执行器受限问题的刚体飞行器非奇异固定时间姿态跟踪控制方法 | |
Lee et al. | Design, implementation, and flight tests of a feedback linearization controller for multirotor UAVs | |
CN110488854A (zh) | 一种基于神经网络估计的刚性飞行器固定时间姿态跟踪控制方法 | |
Cao et al. | Robust flight control design using sensor-based backstepping control for unmanned aerial vehicles | |
Zhang et al. | Adaptive non‐singular fast terminal sliding mode based on prescribed performance for robot manipulators | |
CN104460678B (zh) | 一种基于Sigmoid型非线性滑模函数的航天器姿态控制方法 | |
Li et al. | Repetitive learning control of nonlinear continuous-time systems using quasi-sliding mode | |
CN109062044B (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 |