CN107160398B - 基于确定学习的全状态受限刚性机械臂安全可靠控制方法 - Google Patents

基于确定学习的全状态受限刚性机械臂安全可靠控制方法 Download PDF

Info

Publication number
CN107160398B
CN107160398B CN201710458865.6A CN201710458865A CN107160398B CN 107160398 B CN107160398 B CN 107160398B CN 201710458865 A CN201710458865 A CN 201710458865A CN 107160398 B CN107160398 B CN 107160398B
Authority
CN
China
Prior art keywords
joint
mechanical arm
robot manipulator
neural network
design
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
Application number
CN201710458865.6A
Other languages
English (en)
Other versions
CN107160398A (zh
Inventor
王敏
邹永涛
陈志广
张燕雯
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
South China University of Technology SCUT
Original Assignee
South China University of Technology SCUT
Priority date (The priority date 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 date listed.)
Filing date
Publication date
Application filed by South China University of Technology SCUT filed Critical South China University of Technology SCUT
Priority to CN201710458865.6A priority Critical patent/CN107160398B/zh
Publication of CN107160398A publication Critical patent/CN107160398A/zh
Application granted granted Critical
Publication of CN107160398B publication Critical patent/CN107160398B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Classifications

    • BPERFORMING OPERATIONS; TRANSPORTING
    • B25HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25JMANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J9/00Programme-controlled manipulators
    • B25J9/16Programme controls
    • B25J9/1628Programme controls characterised by the control loop
    • B25J9/163Programme controls characterised by the control loop learning, adaptive, model based, rule based expert control
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B25HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25JMANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J9/00Programme-controlled manipulators
    • B25J9/16Programme controls
    • B25J9/1602Programme controls characterised by the control system, structure, architecture
    • B25J9/161Hardware, e.g. neural networks, fuzzy logic, interfaces, processor
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B25HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25JMANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J9/00Programme-controlled manipulators
    • B25J9/16Programme controls
    • B25J9/1628Programme controls characterised by the control loop
    • B25J9/1651Programme controls characterised by the control loop acceleration, rate control

Abstract

本发明公开了一种基于确定学习的全状态受限刚性机械臂安全可靠控制方法,该方法包括下述步骤:建立全状态受限刚性机械臂的动力学模型和期望的周期轨迹;建立状态转换器;非仿射模型构造成仿射模型;定义转换后机械臂的角位置的跟踪误差;设计补偿跟踪误差信号;设计基于确定学习的神经网络控制器;建立基于经验知识的静态神经网络控制器。该方法不仅能够保证跟踪误差最终收敛到零的小邻域内,还能限制机械臂运行在一个给定的安全的工作区间内,采用确定学习理论,实现了对刚性机械臂不确定闭环动态的学习,并将收敛的神经网络权值进行存储,利用存储的经验知识避免了冗余训练,提高了系统的响应速度,改善了刚性机械臂暂态过程的跟踪性能。

Description

基于确定学习的全状态受限刚性机械臂安全可靠控制方法
技术领域
本发明涉及刚性机械臂全状态受限控制领域,具体涉及一种基于确定学习的全状态受限刚性机械臂安全可靠控制方法。
背景技术
目前机械臂是在机器人技术领域中得到最广泛实际应用的自动化机械装置,除了主要用于工业制造上,商业农业、医疗救援、娱乐服务、军事保全甚至在太空探索等领域都可以发现其应用装置。随着应用场景的增多,任务复杂度的增强,人们对机械臂的工作效率和工作质量要求也越来越高。目前有关机械臂安全控制方面的研究还比较少,机械臂与人交互时,其高刚度容易对周边人员产生伤害。因此,有必要在线规划机械臂的跟踪路径以及运转速度,也就是研究状态受限问题,从而保证人机交互的安全性。然而,采用现有的递推设计方案,大多数的研究结果都是将状态受限控制问题间接地转化为状态跟踪误差受限控制问题,从而不得不引入中间控制量的界限。由于中间控制量的界限难以确定,因此为了不违背受限的状态要求,通常对受限状态的界设定较大,从而大大增加了算法的保守性,使得机械臂的安全工作区域以及运转速度大大受限。
此外,现实中的机械臂系统动态往往不是精确已知的,针对系统中的未知动态,现有的技术通常采用神经网络进行逼近。神经网络逼近系统未知动态过程中,需要不断的在线调整,每做一次任务神经网络需要重新训练一次,在训练的过程中,神经网络的逼近误差比较大,训练过程也需要耗费较长的时间。然而机械臂执行相同的控制任务,神经网络需要逼近的未知动态也是基本一致的,这就使得神经网络的训练过程成为冗余操作。确定学习理论已经证明了RBF神经网络逼近周期或类周期的轨迹时,神经网络权值能够最终收敛并存储为经验知识,因而可利用经验知识实现机械臂系统的高性能控制。
发明内容
本发明的目的是针对上述现有技术的不足,提出了一种基于确定学习的全状态受限刚性机械臂安全可靠控制方法,特别是针对刚性机械臂的状态受限问题,本发明提出了一种新型非线性转换器,将全状态受限的刚性机械臂动力学系统直接转化为全状态不受限的非线性动力学系统,从而避免了应用中间控制量的界限,降低了控制方案设计的保守性。在此基础上,本发明采用命令滤波器并通过设计补偿信号的方法成功解决了传统后推设计可能产生的全状态受限刚性机械臂控制器循环构造问题。最后,针对冗余训练问题,本发明采用基于确定学习的控制方案,将收敛后的神经网络权值存储为经验知识。当机械臂遇到相同的状态受限控制任务时,直接调用经验知识避免了再次训练,实现了全状态受限刚性机械臂安全可靠的低能耗控制。
为了达到上述目的,本发明采用以下技术方案:
本发明一种基于确定学习的全状态受限刚性机械臂安全可靠控制方法,包括以下步骤:
步骤1、建立全状态受限刚性机械臂的动力学模型和期望的周期轨迹:建立以刚性机械臂关节角位置以及关节角速度作为状态变量的刚性机械臂动力学模型和期望的周期轨迹模型;
步骤2、建立状态转换器:将状态受限的模型转换为不受限的模型,同时将参考轨迹模型也进行相应地转换;
其中,-k 1i为机械臂关节i位置x1,i的下界,为机械臂关节i位置x1,i的上界,-k 2i为机械臂关节i速度x2,i的下界,为机械臂关节i速度x2,i的上界,T1,i(s1,i)为第i个关节位置的状态转换器,T2,i(s2,i)为第i个关节速度的状态转换器,s1,i为x1,i转换后的状态变量,s2,i为x2,i转换后的状态变量,n为全状态受限刚性机械臂的关节数,将全状态受限刚性机械臂所有关节的状态转换器写成向量形式为T1(s1)=[T1,1(s1,1),…,T1,n(s1,n)]T,T2(s2)=[T2,1(s2,1),…,T2,n(s2,n)]T
转换后的系统为:
其中,R1(s1)=diag(r1,1(s1,1),…,r1,n(s1,n)),R2(s2)=diag(r2,1(s2,1),…,r2,n(s2,n)),s1=[s1,1,s1,2,…,s1,n]T,s2=[s2,1,s2,2,…,s2,n]T,s1为转换后的机械臂关节角位置,s2为转换后的机械臂关节角速度;
相应地,转换后的参考轨迹为:
sd1=[sd1,1,…,sd1,n]T,sd2=[sd2,1,…,sd2,n]T,sd1为转换后的期望关节角位置,sd2为转换后的期望关节角速度;
步骤3、采用构造性方法,引入下一子系统的状态,将非仿射模型构造成仿射模型;
步骤4、定义转换后机械臂的角位置和任意参考轨迹之间的跟踪误差;
步骤5、设计补偿跟踪误差信号:应用命令滤波并结合后推设计方法设计补偿跟踪误差信号;
步骤6、设计稳定的自适应神经网络控制器:应用李雅普诺夫稳定性理论并结合逐步后推设计方法构造稳定的自适应神经网络控制器,保证跟踪效果,不违背全状态受限;
步骤7、建立基于经验知识的静态神经网络控制器:根据确定学习理论,步骤6中沿刚性机械臂运动轨迹的神经元满足持续激励条件,其权值收敛到最优,取收敛后的神经网络权值保存为设计利用经验知识的静态神经网络控制器。
进一步地,步骤1中,所述全状态受限刚性机械臂的动力学模型为:
其中,x1=[x1,1,x1,2,…,x1,n]T为机械臂关节的角位置,x2=[x2,1,x2,2,…,x2,n]T为机械臂关节的角速度,n为全状态受限刚性机械臂的关节数,k 1=[k 11,…,k 1n]T, k 2=[k 21,…,k 2n]T,为确定的正常数向量,M(x1)为机械臂系统的惯性矩阵,Vm(x1,x2)为向心力矩阵,G(x1)为万有引力向量,F(x2)为摩擦力向量,τ为控制力矩;M(x1),Vm(x1,x2),G(x1),F(x2)均未知。
进一步地,步骤1中,所述全状态受限刚性机械臂期望的周期轨迹为:
其中,xd1=[xd1,1,…,xd1,n]T为关节角位置的期望参考轨迹,xd2=[xd2,1,…,xd2,n]T为关节角速度的期望参考轨迹,xd=[xd1,xd2]T,f(xd1,xd2)为给定的连续函数。
进一步地,步骤3中,所述将非仿射模型构造成含仿射项的形式为:
其中,F1(s1,s2)=R1(s1)T2(s2)-s2
进一步地,步骤4中,所述定义转换后机械臂的位置和任意参考轨迹之间的跟踪误差为:
z1=s1-sd1
其中,s1为转换后的机械臂的关节角位置,sd1为期望的关节角位置,z1为转换后机械臂关节角位置跟踪误差。
进一步地,步骤5中,所述设计补偿跟踪误差信号为:
v1=z11
其中,z1为转换后机械臂的位置和任意参考轨迹之间的跟踪误差,ξ1为补偿信号,v1为补偿跟踪误差信号;
设计虚拟控制器α1
其中,c1为设计常数;
设计命令滤波器为:
其中,ωn>0为命令滤波器的放大系数,为命令滤波器设计常数,为命令滤波器的输出,α1为命令滤波器的输入;
设计补偿信号ξ1
其中,为命令滤波器的输出;
设计s2的补偿跟踪误差信号,
v2=s2-s2,c
进一步地,步骤6中,设计基于确定学习的神经网络控制器为:
其中,c2为R-1 2v2的设计参数,c3为R2v2的设计参数,为神经网络权值的估计值,选取权值更新率为S(Z)=[s1(||Z-θ1||),…,sN(||Z-θN)||]T,sj(·)=exp(-||Z-θj||2j 2)为高斯基函数,θj为中心点,ηj为宽度,j=1,…,N,N为神经网络布点数,Z=[x11,…,x1n,x21,…,x2n]T为神经网络的输入,Γ为神经网络权值更新率的增益项,σ为神经网络权值更新率的设计常数。
进一步地,步骤7中,建立基于经验知识的静态神经网络控制器形式为:
其中,tbi>tai>T,T为收敛时间。
本发明与现有技术相比,具有如下优点和有益效果:
1、本发明通过设计基于确定学习的全状态受限刚性机械臂神经网络控制器,不仅实现了轨迹跟踪误差最终收敛到零的一个小邻域内,还能限制机械臂运行在一个给定的安全的工作区间内,实现了刚性机械臂的精确安全可靠控制。
2、本发明通过设计状态转换函数的方法,将全状态受限的刚性机械臂动力学系统直接转化为不受限的非线性动力学系统,从而避免了应用中间控制量的界限,降低了控制方案设计的保守性。
3、本发明通过设计补偿跟踪误差信号,减少了刚性机械臂滤波产生的误差,克服了传统后推设计中由于连续求导所引起的“计算爆炸”问题。
4、本发明采用确定学习的理论,实现了对刚性机械臂不确定参数进行学习,并将收敛的神经网络权值进行存储,利用存储的经验知识避免了冗余训练,提高了系统的响应速度,改善了刚性机械臂暂态过程的跟踪性能。
附图说明
图1为本发明全状态受限刚性机械臂系统示意图。
图2为本发明全状态受限刚性机械臂的整体控制框图。
图3为本发明状态转换器图。
图4为本发明机械臂关节1角位置受限图。
图5为本发明机械臂关节2角位置受限图。
图6为本发明机械臂关节1角速度受限图。
图7为本发明机械臂关节2角速度受限图。
图8为本发明补偿跟踪误差信号1仿真图。
图9为本发明补偿跟踪误差信号2仿真图。
图10为本发明神经网络权值W1收敛仿真图。
图11为本发明神经网络权值W2收敛仿真图。
图12(a)、图12(b)分别为本发明神经网络训练阶段与经验再利用阶段的控制器1输出仿真图。
图13(a)、图13(b)分别为本发明神经网络训练阶段与经验再利用阶段的控制器2输出仿真图。
图14为本发明神经网络训练阶段和经验再利用阶段关节1跟踪误差收敛对比仿真图。
图15为本发明神经网络训练阶段和经验再利用阶段关节2跟踪误差收敛对比仿真图。
具体实施方式
下面结合实施例及附图对本发明作进一步详细的描述,但本发明的实施方式不限于此。
实施例:
本实施例提供了一种基于确定学习的全状态受限刚性机械臂安全可靠控制方法,全状态受限刚性机械臂系统的示意图如图1所示,整体的控制框图如图2所示,其详细实施过程包括:
步骤1、建立全状态受限刚性机械臂的动力学模型和期望的周期轨迹:
其中,x1=[x1,1,x1,2]T为机械臂关节的角位置,x2=[x2,1,x2,2]T为机械臂关节的角速度,k 1=[k 11,k 12]T, k 2=[k 21,k 22]T,为确定的正常数向量,M(x1)为机械臂系统的惯性矩阵,Vm(x1,x2)为向心力矩阵,G(x1)为万有引力向量,F(x2)为摩擦力向量,τ为控制力矩,M(x1),Vm(x1,x2),G(x1),F(x2)均未知。
本实施例中选取的全状态受限刚性机械臂系统的相关参数分别为:
其中,x1,1,x1,2分别为关节1和关节2的角位置,x2,1,x2,2分别为关节1和关节2的角速度,l1=1m,l2=1m分别为连杆1和连杆2的长度,m1=0.8kg,m2=2.3kg分别为连杆1和连杆2的质量,g=9.8m/s2为重力加速度。
全状态受限刚性机械臂期望的周期轨迹为:
其中,xd=[xd1,xd2]T,xd1=[xd1,1,xd1,2]T为关节角位置的期望参考轨迹,xd2=[xd2,1,xd2,2]T为关节角速度的期望参考轨迹,f(xd1,xd2)为给定的连续函数。
本实例中选取的期望周期轨迹为:
xd=[0.8sin(t),0.6cos(t)]T
步骤2、建立状态转换器:
其中,T1,i(s1,i)为第i个关节位置的状态转换器,T2,i(s2,i)为第i个关节速度的状态转换器,s1,i为x1,i转换后的状态变量,s2,i为x2,i转换后的状态变量,将全状态受限刚性机械臂所有关节的状态转换器写成向量形式为T1(s1)=[T1,1(s1,1),T1,2(s1,2)]T,T2(s2)=[T2,1(s2,1),T2,2(s2,2)]T
转换后的系统为:
其中,R1(s1)=diag(r1,1(s1,1),r1,2(s1,2)),R2(s2)=diag(r2,1(s2,1),r2,2(s2,2)),s1=[s1,1,s1,2]T,s2=[s2,1,s2,2]T,s1为转换后的机械臂关节角位置,s2为转换后的机械臂关节角速度。
相应地,转换后的参考轨迹为:
sd1=[sd1,1,sd1,2]T,sd2=[sd2,1,sd2,2]T,sd1为转换后的期望关节角位置,sd2为转换后的期望关节角速度。
图3为状态转换器图,可以看出该转换器的特点为将受限的x转换为不受限的s,且当x为0时s也为0,当x趋向边界时,s趋向无穷。
步骤3、采用构造性方法,引入下一子系统的状态,将非仿射模型构造成仿射模型:
其中,F1(s1,s2)=R1(s1)T2(s2)-s2
步骤4、定义转换后机械臂的角位置和参考轨迹之间的跟踪误差:
z1=s1-sd1
步骤5、设计补偿跟踪误差信号:
v1=z11
其中,z1为转换后机械臂的位置和任意参考轨迹之间的跟踪误差,ξ1为补偿信号,v1为补偿跟踪误差信号。
设计虚拟控制器α1
其中,c1为误差z1的设计常数,本实例中选择c1=3。
设计命令滤波器为:
其中,ωn>0为命令滤波器的放大系数,为命令滤波器设计常数,为命令滤波器的输出,α1为命令滤波器的输入;本实例选择ωn=20,
设计补偿信号ξ1
其中,为命令滤波器的输出。
设计s2的补偿跟踪误差信号,
v2=s2-s2,c
步骤6、设计稳定的自适应神经网络控制器:应用李雅普诺夫稳定性理论并结合逐步后推设计方法构造稳定的自适应神经网络控制器,保证跟踪效果,不违背全状态受限:
其中,c2为R-1 2v2的设计参数,c3为R2v2的设计参数,为神经网络权值的估计值,选取权值更新率为S(Z)=[s1(||Z-θ1||),…,sN(||Z-θN)||]T,sj(·)=exp(-||Z-θj||2j 2)为高斯基函数,θj为中心点,ηj为宽度,j=1,…,N,N为神经网络布点数,Z=[x11,x12,x21,x22]T为神经网络的输入,Γ为神经网络权值更新率的增益项,σ为神经网络权值更新率的设计常数。
本实例中,x1和x2的初始值为x11(0)=x12(0)=0.2,x21(0)=x22(0)=0.5;神经网络的初始值为神经网络节点数为N=7×7×11×11=5929,中心点均匀分布在[-1 1]×[-1 1]×[-1.2 1.2]×[-1.2 1.2]上,ηj=1;Γ=10,σ=0.0001,c2=80,c3=0。
图4为机械臂关节1角位置受限图。图5为机械臂关节2角位置受限图。图6为机械臂关节1角速度受限图。图7为机械臂关节2角速度受限图。从图4到图7可以看出,机械臂各个关节的位置和速度限制在指定的约束范围内。图8为补偿跟踪误差信号1仿真图。图9为补偿跟踪误差信号2仿真图。从图8和图9可以看出,补偿跟踪误差信号稳定时收敛到零的小邻域内。图10为神经网络权值W1收敛仿真图。图11为神经网络权值W2收敛仿真图。从图10和图11可以看出,神经网络大多数权值收敛到零,只有部分权值收敛到非零常数。
步骤7、建立基于经验知识的静态神经网络控制器:根据确定学习理论,步骤6中沿刚性机械臂运动轨迹的神经元满足持续激励条件,其权值收敛到最优,取收敛后的神经网络权值保存为设计利用经验知识的静态神经网络控制器,即控制器形式为:
其中,tbi>tai>T,T为收敛时间,本实例中T=200,tai=320,tbi=400。
图12(a)、图12(b)分别为神经网络训练阶段与经验再利用阶段的控制器1输出仿真图。图13(a)、图13(b)为神经网络训练阶段与经验再利用阶段的控制器2输出仿真图。图14为神经网络训练阶段和经验再利用阶段关节1跟踪误差收敛对比仿真图。图15为神经网络训练阶段和经验再利用阶段关节2跟踪误差收敛对比仿真图。从图12(a)、图12(b)、图13(a)、图13(b)、图14、图15中可以看出,采用基于经验知识的静态神经网络控制器改善了刚性机械臂暂态过程的跟踪性能。
以上所述,仅为本发明专利较佳的实施例,但本发明专利的保护范围并不局限于此,任何熟悉本技术领域的技术人员在本发明专利所公开的范围内,根据本发明专利的技术方案及其发明专利构思加以等同替换或改变,都属于本发明专利的保护范围。

Claims (6)

1.一种基于确定学习的全状态受限刚性机械臂安全可靠控制方法,其特征在于,所述方法包括以下步骤:
步骤1、建立全状态受限刚性机械臂的动力学模型和期望的周期轨迹模型:建立以刚性机械臂关节角位置以及关节角速度作为状态变量的刚性机械臂动力学模型和期望的周期轨迹模型;
所述刚性机械臂的动力学模型为:
其中x1=[x1,1,x1,2,…,x1,n]T为机械臂关节的角位置,x2=[x2,1,x2,2,…,x2,n]T为机械臂关节的角速度,n为全状态受限刚性机械臂的关节数,k 1=[k 11,…,k 1n]T, k 2=[k 21,…,k 2n]T,为确定的常数向量,M(x1)为机械臂系统的惯性矩阵,Vm(x1,x2)为向心力矩阵,G(x1)为万有引力向量,F(x2)为摩擦力向量,τ为控制力矩;M(x1),Vm(x1,x2),G(x1),F(x2)均未知;
所述刚性机械臂期望的周期轨迹模型为:
其中,xd1=[xd1,1,…,xd1,n]T为关节角位置的期望参考轨迹,xd2=[xd2,1,…,xd2,n]T为关节角速度的期望参考轨迹,xd=[xd1,xd2]T,f(xd1,xd2)为给定的连续函数;
步骤2、建立状态转换器:将状态受限的模型转换为不受限的模型,同时将参考轨迹模型也进行相应地转换;
其中,-k 1i为机械臂关节i位置x1,i的下界,为机械臂关节i位置x1,i的上界,-k 2i为机械臂关节i速度x2,i的下界,为机械臂关节i速度x2,i的上界,T1,i(s1,i)为第i个关节位置的状态转换器,T2,i(s2,i)为第i个关节速度的状态转换器,s1,i为x1,i转换后的状态变量,s2,i为x2,i转换后的状态变量,n为全状态受限刚性机械臂的关节数,将全状态受限刚性机械臂所有关节的状态转换器写成向量形式为T1(s1)=[T1,1(s1,1),…,T1,n(s1,n)]T,T2(s2)=[T2,1(s2,1),…,T2,n(s2,n)]T
转换后的系统为:
其中,R1(s1)=diag(r1,1(s1,1),…,r1,n(s1,n)),R2(s2)=diag(r2,1(s2,1),…,r2,n(s2,n)),s1=[s1,1,s1,2,…,s1,n]T,s2=[s2,1,s2,2,…,s2,n]T,s1为转换后的机械臂关节角位置,s2为转换后的机械臂关节角速度;
相应地,转换后的参考轨迹为:
其中,sd1=[sd1,1,…,sd1,n]T,sd2=[sd2,1,…,sd2,n]T,sd1为转换后的期望关节角位置,sd2为转换后的期望关节角速度;
步骤3、非仿射模型构造成仿射模型:采用构造性方法,引入下一子系统的状态,将非仿射模型构造成仿射模型;
步骤4、定义转换后机械臂的角位置和任意参考轨迹之间的跟踪误差;
步骤5、设计补偿跟踪误差信号:应用命令滤波并结合后推设计方法设计补偿跟踪误差信号;
步骤6、设计稳定的自适应神经网络控制器:应用李雅普诺夫稳定性理论并结合逐步后推设计方法构造稳定的自适应神经网络控制器,保证跟踪效果,不违背全状态受限;
步骤7、建立基于经验知识的静态神经网络控制器:根据确定学习理论,步骤6中沿刚性机械臂运动轨迹的神经元满足持续激励条件,其权值收敛到最优,取收敛后的神经网络权值保存为设计利用经验知识的静态神经网络控制器。
2.根据权利要求1所述的基于确定学习的全状态受限刚性机械臂安全可靠控制方法,其特征在于:步骤3中,所述将非仿射模型构造成含仿射项的形式为:
其中,F1(s1,s2)=R1(s1)T2(s2)-s2
3.根据权利要求1所述的基于确定学习的全状态受限刚性机械臂安全可靠控制方法,其特征在于:步骤4中,所述定义转换后机械臂的位置和任意参考轨迹之间的跟踪误差为:
z1=s1-sd1
其中,s1为转换后机械臂的关节角位置,sd1为转换后机械臂期望的关节角位置,z1为转换后机械臂关节角位置跟踪误差。
4.根据权利要求1所述的基于确定学习的全状态受限刚性机械臂安全可靠控制方法,其特征在于:步骤5中,所述设计补偿跟踪误差信号为:
v1=z11
其中,ξ1为补偿信号,v1为补偿跟踪误差信号;
设计虚拟控制器α1
其中,c1为误差z1的设计参数;
设计命令滤波器为:
其中,ωn>0为命令滤波器的放大系数,为命令滤波器设计常数,为命令滤波器的输出,α1为命令滤波器的输入;
设计补偿信号ξ1
其中,为命令滤波器的输出;
设计s2的补偿跟踪误差信号,
v2=s2-s2,c
5.根据权利要求1所述的基于确定学习的全状态受限刚性机械臂安全可靠控制方法,其特征在于:步骤6中,设计基于确定学习的神经网络控制器为:
其中,c2为R-1 2v2的设计参数,c3为R2v2的设计参数,为神经网络权值的估计值,选取权值更新率为S(Z)=[s1(||Z-θ1||),…,sN(||Z-θN)||]T,sj(·)=exp(-||Z-θj||2j 2)为高斯基函数,θj为中心点,ηj为宽度,j=1,…,N,N为神经网络布点数,Z=[x11,…,x1n,x21,…,x2n]T为神经网络的输入,Γ为神经网络权值更新率的增益项,σ为神经网络权值更新率的设计常数。
6.根据权利要求1所述的基于确定学习的全状态受限刚性机械臂安全可靠控制方法,其特征在于:步骤7中,基于经验知识的静态神经网络控制器形式为:
其中,tbi>tai>T,T为收敛时间。
CN201710458865.6A 2017-06-16 2017-06-16 基于确定学习的全状态受限刚性机械臂安全可靠控制方法 Active CN107160398B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201710458865.6A CN107160398B (zh) 2017-06-16 2017-06-16 基于确定学习的全状态受限刚性机械臂安全可靠控制方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201710458865.6A CN107160398B (zh) 2017-06-16 2017-06-16 基于确定学习的全状态受限刚性机械臂安全可靠控制方法

Publications (2)

Publication Number Publication Date
CN107160398A CN107160398A (zh) 2017-09-15
CN107160398B true CN107160398B (zh) 2019-07-12

Family

ID=59819670

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201710458865.6A Active CN107160398B (zh) 2017-06-16 2017-06-16 基于确定学习的全状态受限刚性机械臂安全可靠控制方法

Country Status (1)

Country Link
CN (1) CN107160398B (zh)

Families Citing this family (11)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN108132598B (zh) * 2017-11-17 2021-06-01 吉林大学 移动装弹机械臂系统动力学模型与轨迹控制
CN109895121A (zh) * 2017-12-07 2019-06-18 泰科电子(上海)有限公司 机械臂控制系统和方法
CN109227543B (zh) * 2018-10-19 2020-07-28 华南理工大学 一种位置受限柔性关节机器人基于模式的智能控制方法
CN109352656B (zh) * 2018-11-29 2021-01-19 华南理工大学 一种具有时变输出约束的多关节机械臂控制方法
CN110320804B (zh) * 2019-07-19 2022-06-17 中国人民解放军空军工程大学 一种非仿射动力学系统的控制方法
CN110434858B (zh) * 2019-09-11 2020-11-17 青岛大学 一种基于命令滤波的多机械臂系统的力/位混合控制方法
CN112051734B (zh) * 2020-08-18 2021-07-23 华南理工大学 一种基于确定学习的轮式移动机器人事件触发跟踪控制方法
CN113110377B (zh) * 2021-03-29 2022-03-15 华南理工大学 一种采样机械臂闭环控制系统的小故障检测方法
CN115870966A (zh) * 2021-09-28 2023-03-31 中国科学院沈阳自动化研究所 一种基于d-s证据合成理论的速度协调方法
CN116619383B (zh) * 2023-06-21 2024-02-20 山东大学 基于确定学习的机械臂pid控制方法及系统
CN117539153A (zh) * 2023-11-21 2024-02-09 山东大学 基于确定学习的上肢康复机器人自适应控制方法及系统

Citations (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US7418432B2 (en) * 2000-05-27 2008-08-26 Georgia Tech Research Corporation Adaptive control system having direct output feedback and related apparatuses and methods
CN106078741A (zh) * 2016-06-21 2016-11-09 华南理工大学 基于确定学习理论的性能受限柔性机械臂控制方法
CN106393116A (zh) * 2016-11-18 2017-02-15 山东大学 具有初态学习的机械臂分数阶迭代学习控制方法及系统

Family Cites Families (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US20050137724A1 (en) * 2003-10-10 2005-06-23 Georgia Tech Research Corporation Adaptive observer and related method

Patent Citations (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US7418432B2 (en) * 2000-05-27 2008-08-26 Georgia Tech Research Corporation Adaptive control system having direct output feedback and related apparatuses and methods
CN106078741A (zh) * 2016-06-21 2016-11-09 华南理工大学 基于确定学习理论的性能受限柔性机械臂控制方法
CN106393116A (zh) * 2016-11-18 2017-02-15 山东大学 具有初态学习的机械臂分数阶迭代学习控制方法及系统

Non-Patent Citations (1)

* Cited by examiner, † Cited by third party
Title
Dynamic Learning From Adaptive Neural Control of Robot Manipulators With Prescribed Performance;Min Wang,Anle Yang;《IEEE TRANSACTIONS ON SYSTEMS, MAN, AND CYBERNETICS: SYSTEMS》;20170106;2244-2255

Also Published As

Publication number Publication date
CN107160398A (zh) 2017-09-15

Similar Documents

Publication Publication Date Title
CN107160398B (zh) 基于确定学习的全状态受限刚性机械臂安全可靠控制方法
CN112904728B (zh) 一种基于改进型趋近律的机械臂滑模控制轨迹跟踪方法
CN106406085B (zh) 基于跨尺度模型的空间机械臂轨迹跟踪控制方法
Veysi et al. A novel self-adaptive modified bat fuzzy sliding mode control of robot manipulator in presence of uncertainties in task space
CN109946975A (zh) 一种未知伺服系统的强化学习最优跟踪控制方法
CN106959610B (zh) 桥式吊车系统apd-smc控制器、桥式吊车系统及控制方法
CN110977988B (zh) 基于有限时间命令滤波的多关节机械臂阻抗控制方法
Dian et al. Modeling and trajectory tracking control for magnetic wheeled mobile robots based on improved dual-heuristic dynamic programming
CN109343350A (zh) 一种基于模型预测控制的水下机器人路径跟踪控制方法
CN111185907B (zh) 一种作业型飞行机器人抓取后的位姿稳定控制方法
Abiyev et al. Fuzzy control of omnidirectional robot
CN109901403A (zh) 一种自主水下机器人神经网络s面控制方法
CN109352656B (zh) 一种具有时变输出约束的多关节机械臂控制方法
CN111679579A (zh) 针对传感器和执行器故障系统的滑模预测容错控制方法
CN106393116A (zh) 具有初态学习的机械臂分数阶迭代学习控制方法及系统
Kim et al. Approach of team snu to the darpa robotics challenge finals
Kapnopoulos et al. A cooperative particle swarm optimization approach for tuning an MPC-based quadrotor trajectory tracking scheme
CN107263483A (zh) 二自由度关节机器人轨迹的协调控制方法
CN115256401A (zh) 一种基于强化学习的空间机械臂轴孔装配变阻抗控制方法
CN113219825B (zh) 一种四足机器人单腿轨迹跟踪控制方法及系统
CN107511830B (zh) 一种五自由度混联机器人控制器参数自适应调整实现方法
CN109176529B (zh) 一种空间机器人协调运动的自适应模糊控制方法
Boudjedir et al. Fuzzy logic iterative learning control for trajectory tracking of parallel kinematic manipulators
WO2023165174A1 (zh) 构建机器人的控制器的方法、机器人的运动控制方法、装置以及机器人
Okuma et al. A neural network compensator for uncertainties of robotic manipulators

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