CN107498554A - 一种基于动态模式的机械臂智能自主控制方法 - Google Patents
一种基于动态模式的机械臂智能自主控制方法 Download PDFInfo
- Publication number
- CN107498554A CN107498554A CN201710636750.1A CN201710636750A CN107498554A CN 107498554 A CN107498554 A CN 107498554A CN 201710636750 A CN201710636750 A CN 201710636750A CN 107498554 A CN107498554 A CN 107498554A
- Authority
- CN
- China
- Prior art keywords
- dynamic
- dynamic mode
- mode
- controller
- mechanical arm
- 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
-
- 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/1602—Programme controls characterised by the control system, structure, architecture
- B25J9/161—Hardware, e.g. neural networks, fuzzy logic, interfaces, processor
-
- 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/1628—Programme controls characterised by the control loop
-
- 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
Landscapes
- Engineering & Computer Science (AREA)
- Automation & Control Theory (AREA)
- Mechanical Engineering (AREA)
- Artificial Intelligence (AREA)
- Evolutionary Computation (AREA)
- Software Systems (AREA)
- Robotics (AREA)
- Physics & Mathematics (AREA)
- Fuzzy Systems (AREA)
- Mathematical Physics (AREA)
- Health & Medical Sciences (AREA)
- Computer Vision & Pattern Recognition (AREA)
- Medical Informatics (AREA)
- General Physics & Mathematics (AREA)
- Feedback Control In General (AREA)
Abstract
本发明公开了一种基于动态模式的机械臂智能自主控制方法,该方法包括下述步骤:建立刚性机械臂的动力学模型和多个期望回归轨迹的通用模型;设计基于动态模式的常值神经网络控制器组;建立期望回归轨迹模型的动态估计器;设计动态模式的预识别策略和识别策略;设计基于动态模式的控制器切换策略。该方法使得机械臂能够从复杂的工作任务中获取和利用经验知识,不仅实现了机械臂系统在无人干预的情况下对动态模式的实时监测以及自主快速识别,而且保证了机械臂在模式切换过程中控制输入信号的光滑连续性,为控制系统的稳定性提供了保障,同时改善了系统控制器切换过程中的暂态性能。
Description
技术领域
本发明涉及基于模式识别的机械臂控制领域,具体涉及一种基于动态模式的机械臂智能自主控制方法。
背景技术
机器人的诞生和发展为人类科技和社会的进步带来了深远影响。作为机器人的一个重要分支,机械臂凭借其生产效率高和耐用性等优点,被广泛应用于工业生产、医疗以及太空探索等多个领域,以代替人力完成劳动强度大、安全风险高和操作环境复杂的工作。而随着机械臂应用领域的不断扩大以及智能制造业的快速发展,人们对机械臂控制系统的智能化程度要求越来越高,例如要求机械臂在复杂的工作任务中能够获取经验知识,并利用经验知识保证更好的工作效率和工作质量。
近年来,基于模式识别的控制系统研究得到学者们的热切关注,然而以机械臂为控制对象的模式控制研究应用仍较少。基于动态模式的机械臂控制系统要求机械臂在执行任务的同时,能够实时监测需要执行的任务模式。但是由于机械臂本身不具备任务模式识别的能力,如果任务在无法人为告知的情况下突然发生改变,机械臂的控制性能将受到严重影响。而且,当机械臂在不同的任务之间作切换时,涉及到控制器切换时存在的控制输入跳变问题,输入信号的跳变会对机械臂的驱动机构造成损害,从而破坏控制系统的稳定性。因此,有必要建立一个动态模式识别机制实时监测和自主识别机械臂需要执行的任务模式,同时设计控制器切换策略保证机械臂在不同任务模式之间作切换时控制输入信号的光滑连续性,也就是基于动态模式的机械臂智能自主控制方法。传统的模式识别方法一般用于处理静态环境下的模式识别问题,而且要求不同模式之间在本质属性上存在一定的差别以便划分,因此在应用范围上存在局限性,并不能解决现实中大多数的模式识别问题。而事实上,基于动态模式的控制方法在设计上不仅要使得动态环境下的模式识别机制实时有效运行,而且要保证控制系统在控制性能上的稳定性,因此在算法实现方面更为复杂。
发明内容
本发明的目的是针对现有技术的不足,提供了一种基于动态模式的机械臂智能自主控制方法,针对动态环境下的模式识别问题,提出了模式预识别策略以及模式识别策略,实现了机械臂系统对动态模式的实时监测和快速识别,为保证机械臂系统的控制性能提供了前提条件;同时在此基础上,根据所构造的常值神经网络控制器组,设计了基于动态模式的控制器切换策略,成功解决了控制器切换时存在的控制输入跳变问题,保障了控制系统的稳定性。
本发明的目的可以通过如下技术方案实现:
一种基于动态模式的机械臂智能自主控制方法,所述方法包括以下步骤:
步骤1、建立刚性机械臂动力学模型和多个期望回归轨迹的通用模型;
步骤2、设计基于动态模式的常值神经网络控制器组:定义每种期望回归轨迹为一种动态模式,根据确定学习理论,设计常值神经网络控制器组;
步骤3、建立期望回归轨迹模型的动态估计器:针对不同的动态模式下的期望回归轨迹模型,建立一个动态模式库,然后根据动态模式库构造动态估计器;
步骤4、设计动态模式的预识别策略和识别策略:
设计决策范数其中,N表示动态模式的数目,给出如下模式预识别策略和模式识别策略:
模式预识别策略:假设当前动态模式为i,设计阈值bi>0以及常数Tp>0,若存在某个有限时刻使得在成立,则判定在有限时刻动态模式已发生改变,其中,表示动态模式i对应的决策范数;
模式识别策略:基于以上模式预识别策略得到的信息,对所有r∈{1,…,N}/{j},若存在一个有限时刻使得且在时间成立,则判定被测模式为动态模式j;其中,表示动态模式j对应的决策范数在有限时刻的值,表示动态模式r对应的决策范数在有限时刻的值,表示动态模式j对应的决策范数在时间的值;
步骤5、设计基于动态模式的控制器切换策略:由步骤4中模式识别策略和预识别策略所给的信息,以及根据步骤2中构造的候选常值神经网络控制器组,设计如下动态模式切换过程中的控制器:
其中,τi表示动态模式i对应的控制器,τi′表示识别过程的控制器,表示模式识别的过渡时间段,τj表示下一动态模式j对应的控制器,表示τj的作用时间段,指数项中的衰减系数a>0。
进一步地,步骤1中,所述刚性机械臂的动力学模型为:
其中,x1=[x1,1,x1,2,…,x1,n]T为机械臂关节的角位移,x2=[x2,1,x2,2,…,x2,n]T为机械臂关节的角速度,n为机械臂的关节数,M(x1)为机械臂系统的惯性矩阵,Vm(x1,x2)为向心力矩阵,G(x1)为万有引力向量,F(x2)为摩擦力向量,τ为控制力矩;M(x1),Vm(x1,x2),G(x1),F(x2)均未知。
进一步地,步骤1中,所述期望回归轨迹的通用模型为:
其中,为机械臂关节角位置的期望回归轨迹,为机械臂关节角速度的期望回归轨迹,n为关节数量,为给定的连续函数。
进一步地,步骤2中,所述基于动态模式的常值神经网络控制器组为:
其中,τk表示动态模式k下的常值神经网络控制器,c2,k为控制器增益常数,z2,k表示控制器τk的中间误差,表示控制器τk的神经网络权值常量矩阵的转置,Sk(ψk)表示控制器τk的高斯型径向基函数向量,ψk为控制器τk的神经网络输入向量。
进一步地,步骤3中,所述动态模式库为:
其中,为动态模式k的神经网络权值常量矩阵。
进一步地,步骤3中,所述动态估计器为:
其中,为第k个动态估计器的状态,xd1和xd2为被测模式的回归轨迹模型的状态,b>0为动态估计器中设计的增益常数,Sk(xd1,xd2)表示第k个动态估计器的高斯型径向基函数向量,表示动态模式k的神经网络权值常量矩阵的转置。
进一步地,步骤4中,所述决策范数为:
其中,残差 表示第k个动态估计器的状态,xd2表示被测模式的回归轨迹模型的状态,T>0为设计的时间常数。
进一步地,步骤5中,所述识别过程的控制器为:
其中,表示模式轨迹的训练域,表示模式轨迹的训练域;当时,控制器τi′采用原控制增益c2,i;当时,控制器τi′采用高控制增益满足条件其中,z2,i表示控制器τi′的中间误差,表示控制器τi′的神经网络权值常量矩阵的转置,Si(ψi)表示控制器τi′的高斯型径向基函数向量,ψi为控制器τi′的神经网络输入向量。
本发明与现有技术相比,具有如下优点和有益效果:
1、本发明通过设计模式预识别策略和模式识别策略,成功解决了控制系统在动态环境下的模式分类与识别问题,使得机械臂系统在被监测模式发生改变时能够自主且快速地做出响应,并对该模式做出准确识别。
2、本发明通过设计基于动态模式的控制器切换策略,成功解决了控制器切换时存在的控制输入跳变问题,保障了控制系统的稳定性,改善了系统控制器切换过程中的暂态性能。
3、本发明通过设计基于动态模式的机械臂控制系统,使得机械臂能够从复杂的工作任务中获取和利用经验知识,从而实现了机械臂在多种工作任务下的智能自主控制。
附图说明
图1为本发明实施例基于动态模式的刚性机械臂系统的整体控制流程图。
图2为本发明实施例期望回归轨迹的相平面变化曲线图。
图3为本发明实施例决策范数变化曲线图。
图4为本发明实施例机械臂关节1的轨迹跟踪误差变化曲线图。
图5为本发明实施例机械臂关节2的轨迹跟踪误差变化曲线图。
图6为本发明实施例机械臂关节1和期望回归轨迹的角位置变化曲线图。
图7为本发明实施例机械臂关节2和期望回归轨迹的角位置变化曲线图。
图8为本发明实施例机械臂关节1的控制输入变化曲线图。
图9为本发明实施例机械臂关节2的控制输入变化曲线图。
具体实施方式
下面结合实施例及附图对本发明作进一步详细的描述,但本发明的实施方式不限于此。
实施例:
本实施例提供了一种基于动态模式的双连杆刚性机械臂智能自主控制方法,系统整体控制流程图如图1所示,其详细实施过程包括:
步骤1、建立双连杆刚性机械臂的动力学模型:
其中,x1=[x1,1,x1,2]T为机械臂关节的角位移,x2=[x2,1,x2,2]T为机械臂关节的角速度,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为重力加速度。
本实施例中给定三种期望回归轨迹的通用模型为:
其中,xd1=[xd1,1,xd1,2]T为机械臂关节角位置的期望回归轨迹,xd2=[xd2,1,xd2,2]T为机械臂关节角速度的期望回归轨迹,为给定的连续函数,将每种期望回归轨迹定义为一种动态模式,同时将连续函数分别选定为:和
步骤2、设计基于动态模式的常值神经网络控制器组:
根据确定学习理论,构造RBF神经网络逼近控制系统的未知动态,由收敛后的权值W得到以下基于动态模式的常值神经网络控制器组:
其中,c2,k为控制器增益常数,z2,k表示控制器τk的中间误差,表示控制器τk的神经网络权值常量矩阵的转置,Sk(ψk)表示控制器τk的高斯型径向基函数向量,ψk为控制器τk的神经网络输入向量,本实施例中选取c2,1=15,c2,2=10,c2,3=10。
步骤3、建立期望回归轨迹模型的动态估计器:
针对不同的动态模式下的期望回归轨迹模型,根据确定学习理论,构造RBF神经网络逼近轨迹模型的未知动态,由收敛后的权值建立如下动态模式库:
其中,为动态模式k的神经网络权值常量矩阵。
然后根据动态模式库构造以下动态估计器:
其中,为第k个动态估计器的状态,xd1和xd2为被测模式的回归轨迹模型的状态,b>0为动态估计器中设计的增益常数,Sk(xd1,xd2)表示第k个动态估计器的高斯型径向基函数向量,表示动态模式k的神经网络权值常量矩阵的转置,本实施例中选取b=5。
步骤4、设计动态模式的预识别策略和识别策略:根据所构造的动态估计器,设计决策范数形式为:
其中,残差 表示第k个动态估计器的状态,xd2表示被测模式的回归轨迹模型的状态,T>0为设计的时间常数,本实施例中选取T=4s;
并给出如下模式预识别策略和模式识别策略:
模式预识别策略:假设当前动态模式为i,设计阈值bi以及常数Tp,若存在某个有限时刻使得在成立,则判定在时刻动态模式已发生改变,其中,表示动态模式i对应的决策范数,本实例中选取b1=0.0007,b2=0.0025,b3=0.0034,Tp=0.1s;
模式识别策略:基于以上模式预识别策略得到的信息,对所有r∈{1,2,3}/{j},若存在一个有限时刻使得且在时间成立,则判定被测模式为动态模式j,其中,表示动态模式j对应的决策范数在有限时刻的值,表示动态模式r对应的决策范数在有限时刻的值,表示动态模式j对应的决策范数在时间的值。
步骤5、设计基于动态模式的控制器切换策略:
由步骤4中模式识别策略和预识别策略所给的信息,以及根据步骤2中构造的候选常值神经网络控制器组,设计如下动态模式切换过程中的控制器:
其中,τi表示动态模式i对应的控制器,τi′表示识别过程的控制器,表示模式识别的过渡时间段,τj表示下一动态模式j对应的控制器,表示τj的作用时间段,指数项中的衰减系数a>0,本实例中选取a=5。识别过程的控制器具有以下形式:
其中,表示模式轨迹的训练域,表示模式轨迹的训练域;当时,控制器τi′采用原控制增益c2,i;当时,控制器τi′采用高控制增益满足条件其中,z2,i表示控制器τi′的中间误差,表示控制器τi′的神经网络权值常量矩阵的转置,Si(ψi)表示控制器τi′的高斯型径向基函数向量,ψi为控制器τi′的神经网络输入向量,本实例中选取
本实施例中,x1和x2的初始值为x1,1(0)=0.2,x1,2(0)=0,x2,1(0)=x2,2(0)=0;动态模式1的神经网络中心点均匀分布在[-1,1]×[-1,1]×[-1.2,1.2]×[-1.2,1.2]×[-1.6,1.6]×[-1.6,1.6]上,宽度为η1=[0.625,0.625,0.75,0.75,1,1]T,节点数为15625;动态模式2的神经网络中心点均匀分布在[-2.4,2.4]×[-2.4,2.4]×[-4,4]×[-4,4]×[-8,8]×[-8,8]上,宽度为η2=[1.5,1.5,2.5,2.5,5,5]T,节点数为15625;动态模式3的神经网络中心点均匀分布在[-2.4,2.4]×[-2.4,2.4]×[-2.4,2.4]×[-2.4,2.4]×[-5,5]×[-5,5]上,宽度为η2=[1.5,1.5,1.5,1.5,3.2,3.2]T,节点数为15625。
本实施例选取期望回归轨迹在系统运行时间段内先从动态模式1切换到动态模式2,再从动态模式2切换到动态模式3,其相平面变化曲线如图2所示,图3为决策范数变化曲线,由图3可知,根据模式预识别策略,系统分别在和处检测到期望回归轨迹的模式发生改变,然后根据模式识别策略,系统在和tc 2=102.3s处给出相应的模式识别结果;图4和图5分别为机械臂关节1和关节2的轨迹跟踪误差变化曲线图,由图4和图5可知,系统在模式识别过渡阶段通过控制器切换策略较好地抑制住了跟踪误差的增大;图6为机械臂关节1和期望回归轨迹的角位置变化曲线图,图7为机械臂关节2和期望回归轨迹的角位置变化曲线图;图8和图9分别为机械臂关节1和关节2的控制输入变化曲线图,由图8和图9可知,根据模式识别结果和控制器切换策略,系统在进行控制器切换时保证了控制信号的光滑连续性,从而保障了系统的稳定性。
以上所述,仅为本发明专利较佳的实施例,但本发明专利的保护范围并不局限于此,任何熟悉本技术领域的技术人员在本发明专利所公开的范围内,根据本发明专利的技术方案及其发明专利构思加以等同替换或改变,都属于本发明专利的保护范围。
Claims (8)
1.一种基于动态模式的机械臂智能自主控制方法,其特征在于,所述方法包括以下步骤:
步骤1、建立刚性机械臂动力学模型和多个期望回归轨迹的通用模型;
步骤2、设计基于动态模式的常值神经网络控制器组:定义每种期望回归轨迹为一种动态模式,根据确定学习理论,设计常值神经网络控制器组;
步骤3、建立期望回归轨迹模型的动态估计器:针对不同的动态模式下的期望回归轨迹模型,建立一个动态模式库,然后根据动态模式库构造动态估计器;
步骤4、设计动态模式的预识别策略和识别策略:
设计决策范数其中,N表示动态模式的数目,给出如下模式预识别策略和模式识别策略:
模式预识别策略:假设当前动态模式为i,设计阈值bi>0以及常数Tp>0,若存在某个有限时刻使得在成立,则判定在有限时刻动态模式已发生改变,其中,表示动态模式i对应的决策范数;
模式识别策略:基于以上模式预识别策略得到的信息,对所有r∈{1,…,N}/{j},若存在一个有限时刻使得且在时间成立,则判定被测模式为动态模式j;其中,表示动态模式j对应的决策范数在有限时刻的值,表示动态模式r对应的决策范数在有限时刻的值,表示动态模式j对应的决策范数在时间的值;
步骤5、设计基于动态模式的控制器切换策略:由步骤4中模式识别策略和预识别策略所给的信息,以及根据步骤2中构造的候选常值神经网络控制器组,设计如下动态模式切换过程中的控制器:
<mrow>
<mi>&tau;</mi>
<mo>=</mo>
<mfenced open = "{" close = "">
<mtable>
<mtr>
<mtd>
<mrow>
<msup>
<mrow>
<mo>&lsqb;</mo>
<msup>
<mi>&tau;</mi>
<mi>i</mi>
</msup>
<mrow>
<mo>(</mo>
<msubsup>
<mi>t</mi>
<mi>p</mi>
<mi>i</mi>
</msubsup>
<mo>)</mo>
</mrow>
<mo>-</mo>
<msup>
<mi>&tau;</mi>
<msup>
<mi>i</mi>
<mo>&prime;</mo>
</msup>
</msup>
<mo>&rsqb;</mo>
</mrow>
<mrow>
<mo>-</mo>
<mi>a</mi>
<mrow>
<mo>(</mo>
<mi>t</mi>
<mo>-</mo>
<msubsup>
<mi>t</mi>
<mi>p</mi>
<mi>i</mi>
</msubsup>
<mo>)</mo>
</mrow>
</mrow>
</msup>
<mi>e</mi>
<mo>+</mo>
<msup>
<mi>&tau;</mi>
<msup>
<mi>i</mi>
<mo>&prime;</mo>
</msup>
</msup>
<mo>,</mo>
<mi>t</mi>
<mo>&Element;</mo>
<mo>(</mo>
<msubsup>
<mi>t</mi>
<mi>p</mi>
<mi>i</mi>
</msubsup>
<mo>,</mo>
<msubsup>
<mi>t</mi>
<mi>c</mi>
<mi>j</mi>
</msubsup>
<mo>&rsqb;</mo>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<mo>&lsqb;</mo>
<msup>
<mi>&tau;</mi>
<msup>
<mi>i</mi>
<mo>&prime;</mo>
</msup>
</msup>
<mrow>
<mo>(</mo>
<msubsup>
<mi>t</mi>
<mi>c</mi>
<mi>j</mi>
</msubsup>
<mo>)</mo>
</mrow>
<mo>-</mo>
<msup>
<mi>&tau;</mi>
<mi>j</mi>
</msup>
<mo>&rsqb;</mo>
<msup>
<mi>e</mi>
<mrow>
<mo>-</mo>
<mi>a</mi>
<mrow>
<mo>(</mo>
<mi>t</mi>
<mo>-</mo>
<msubsup>
<mi>t</mi>
<mi>c</mi>
<mi>j</mi>
</msubsup>
<mo>)</mo>
</mrow>
</mrow>
</msup>
<mo>+</mo>
<msup>
<mi>&tau;</mi>
<mi>j</mi>
</msup>
<mo>,</mo>
<mi>t</mi>
<mo>&Element;</mo>
<mo>(</mo>
<msubsup>
<mi>t</mi>
<mi>c</mi>
<mi>j</mi>
</msubsup>
<mo>,</mo>
<msubsup>
<mi>t</mi>
<mi>p</mi>
<mi>j</mi>
</msubsup>
<mo>&rsqb;</mo>
</mrow>
</mtd>
</mtr>
</mtable>
</mfenced>
</mrow>
其中,τi表示动态模式i对应的控制器,τi′表示识别过程的控制器,表示模式识别的过渡时间段,τj表示下一动态模式j对应的控制器,表示τj的作用时间段,指数项中的衰减系数a>0。
2.根据权利要求1所述的一种基于动态模式的机械臂智能自主控制方法,其特征在于,步骤1中,所述刚性机械臂的动力学模型为:
<mfenced open = "{" close = "">
<mtable>
<mtr>
<mtd>
<msub>
<mover>
<mi>x</mi>
<mo>&CenterDot;</mo>
</mover>
<mn>1</mn>
</msub>
<mo>=</mo>
<msub>
<mi>x</mi>
<mn>2</mn>
</msub>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<msub>
<mover>
<mi>x</mi>
<mo>&CenterDot;</mo>
</mover>
<mn>2</mn>
</msub>
<mo>=</mo>
<mi>M</mi>
<msup>
<mrow>
<mo>(</mo>
<msub>
<mi>x</mi>
<mn>1</mn>
</msub>
<mo>)</mo>
</mrow>
<mrow>
<mo>-</mo>
<mn>1</mn>
</mrow>
</msup>
<mo>&lsqb;</mo>
<mo>-</mo>
<msub>
<mi>V</mi>
<mi>m</mi>
</msub>
<mrow>
<mo>(</mo>
<msub>
<mi>x</mi>
<mn>1</mn>
</msub>
<mo>,</mo>
<msub>
<mi>x</mi>
<mn>2</mn>
</msub>
<mo>)</mo>
</mrow>
<msub>
<mi>x</mi>
<mn>2</mn>
</msub>
<mo>-</mo>
<mi>G</mi>
<mrow>
<mo>(</mo>
<msub>
<mi>x</mi>
<mn>1</mn>
</msub>
<mo>)</mo>
</mrow>
<mo>-</mo>
<mi>F</mi>
<mrow>
<mo>(</mo>
<msub>
<mi>x</mi>
<mn>2</mn>
</msub>
<mo>)</mo>
</mrow>
<mo>&rsqb;</mo>
<mo>+</mo>
<mi>M</mi>
<msup>
<mrow>
<mo>(</mo>
<msub>
<mi>x</mi>
<mn>1</mn>
</msub>
<mo>)</mo>
</mrow>
<mrow>
<mo>-</mo>
<mn>1</mn>
</mrow>
</msup>
<mi>&tau;</mi>
</mrow>
</mtd>
</mtr>
</mtable>
</mfenced>
其中,x1=[x1,1,x1,2,…,x1,n]T为机械臂关节的角位移,x2=[x2,1,x2,2,…,x2,n]T为机械臂关节的角速度,n为机械臂的关节数,M(x1)为机械臂系统的惯性矩阵,Vm(x1,x2)为向心力矩阵,G(x1)为万有引力向量,F(x2)为摩擦力向量,τ为控制力矩。
3.根据权利要求1所述的一种基于动态模式的机械臂智能自主控制方法,其特征在于,步骤1中,所述期望回归轨迹的通用模型为:
<mfenced open = "{" close = "">
<mtable>
<mtr>
<mtd>
<msubsup>
<mover>
<mi>x</mi>
<mo>&CenterDot;</mo>
</mover>
<mrow>
<mi>d</mi>
<mn>1</mn>
</mrow>
<mi>k</mi>
</msubsup>
<mo>=</mo>
<msubsup>
<mi>x</mi>
<mrow>
<mi>d</mi>
<mn>2</mn>
</mrow>
<mi>k</mi>
</msubsup>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<msubsup>
<mover>
<mi>x</mi>
<mo>&CenterDot;</mo>
</mover>
<mrow>
<mi>d</mi>
<mn>2</mn>
</mrow>
<mi>k</mi>
</msubsup>
<mo>=</mo>
<msubsup>
<mi>f</mi>
<mi>d</mi>
<mi>k</mi>
</msubsup>
<mrow>
<mo>(</mo>
<msubsup>
<mi>x</mi>
<mrow>
<mi>d</mi>
<mn>1</mn>
</mrow>
<mi>k</mi>
</msubsup>
<mo>,</mo>
<msubsup>
<mi>x</mi>
<mrow>
<mi>d</mi>
<mn>2</mn>
</mrow>
<mi>k</mi>
</msubsup>
<mo>)</mo>
</mrow>
<mo>,</mo>
<mi>k</mi>
<mo>&Element;</mo>
<mo>{</mo>
<mn>1</mn>
<mo>,</mo>
<mo>...</mo>
<mo>,</mo>
<mi>N</mi>
<mo>}</mo>
</mrow>
</mtd>
</mtr>
</mtable>
</mfenced>
其中,为机械臂关节角位置的期望回归轨迹,为机械臂关节角速度的期望回归轨迹,n为关节数量,为给定的连续函数。
4.根据权利要求1所述的一种基于动态模式的机械臂智能自主控制方法,其特征在于,步骤2中,所述基于动态模式的常值神经网络控制器组为:
<mrow>
<msub>
<mi>&Sigma;</mi>
<mi>&tau;</mi>
</msub>
<mo>=</mo>
<mo>{</mo>
<msup>
<mi>&tau;</mi>
<mi>k</mi>
</msup>
<mo>=</mo>
<mo>-</mo>
<msub>
<mi>c</mi>
<mrow>
<mn>2</mn>
<mo>,</mo>
<mi>k</mi>
</mrow>
</msub>
<msub>
<mi>z</mi>
<mrow>
<mn>2</mn>
<mo>,</mo>
<mi>k</mi>
</mrow>
</msub>
<mo>-</mo>
<msup>
<mover>
<mi>W</mi>
<mo>&OverBar;</mo>
</mover>
<mrow>
<mi>k</mi>
<mi>T</mi>
</mrow>
</msup>
<msup>
<mi>S</mi>
<mi>k</mi>
</msup>
<mrow>
<mo>(</mo>
<msup>
<mi>&psi;</mi>
<mi>k</mi>
</msup>
<mo>)</mo>
</mrow>
<mo>|</mo>
<mi>k</mi>
<mo>=</mo>
<mn>1</mn>
<mo>,</mo>
<mo>...</mo>
<mo>,</mo>
<mi>N</mi>
<mo>}</mo>
</mrow>
其中,τk表示动态模式k下的常值神经网络控制器,c2,k为控制器增益常数,z2,k表示控制器τk的中间误差,表示控制器τk的神经网络权值常量矩阵的转置,Sk(ψk)表示控制器τk的高斯型径向基函数向量,ψk为控制器τk的神经网络输入向量。
5.根据权利要求1所述的一种基于动态模式的机械臂智能自主控制方法,其特征在于,步骤3中,所述动态模式库为:
<mrow>
<msub>
<mi>&chi;</mi>
<mrow>
<mi>l</mi>
<mi>i</mi>
<mi>b</mi>
</mrow>
</msub>
<mo>=</mo>
<mo>{</mo>
<msubsup>
<mover>
<mi>W</mi>
<mo>&OverBar;</mo>
</mover>
<mi>d</mi>
<mi>k</mi>
</msubsup>
<mo>|</mo>
<mi>k</mi>
<mo>=</mo>
<mn>1</mn>
<mo>,</mo>
<mo>...</mo>
<mo>,</mo>
<mi>N</mi>
<mo>}</mo>
</mrow>
其中,为动态模式k的神经网络权值常量矩阵。
6.根据权利要求1所述的一种基于动态模式的机械臂智能自主控制方法,其特征在于,步骤3中,所述动态估计器为:
<mrow>
<msubsup>
<mover>
<mover>
<mi>x</mi>
<mo>&OverBar;</mo>
</mover>
<mo>&CenterDot;</mo>
</mover>
<mrow>
<mi>d</mi>
<mn>2</mn>
</mrow>
<mi>k</mi>
</msubsup>
<mo>=</mo>
<mo>-</mo>
<mi>b</mi>
<mrow>
<mo>(</mo>
<msubsup>
<mover>
<mi>x</mi>
<mo>&OverBar;</mo>
</mover>
<mrow>
<mi>d</mi>
<mn>2</mn>
</mrow>
<mi>k</mi>
</msubsup>
<mo>-</mo>
<msub>
<mi>x</mi>
<mrow>
<mi>d</mi>
<mn>2</mn>
</mrow>
</msub>
<mo>)</mo>
</mrow>
<mo>+</mo>
<msubsup>
<mover>
<mi>W</mi>
<mo>&OverBar;</mo>
</mover>
<mi>d</mi>
<mrow>
<mi>k</mi>
<mi>T</mi>
</mrow>
</msubsup>
<msup>
<mi>S</mi>
<mi>k</mi>
</msup>
<mrow>
<mo>(</mo>
<msub>
<mi>x</mi>
<mrow>
<mi>d</mi>
<mn>1</mn>
</mrow>
</msub>
<mo>,</mo>
<msub>
<mi>x</mi>
<mrow>
<mi>d</mi>
<mn>2</mn>
</mrow>
</msub>
<mo>)</mo>
</mrow>
<mo>,</mo>
<mi>k</mi>
<mo>&Element;</mo>
<mo>{</mo>
<mn>1</mn>
<mo>,</mo>
<mo>...</mo>
<mo>,</mo>
<mi>N</mi>
<mo>}</mo>
</mrow>
其中,为第k个动态估计器的状态,xd1和xd2为被测模式的回归轨迹模型的状态,b>0为动态估计器中设计的增益常数,Sk(xd1,xd2)表示第k个动态估计器的高斯型径向基函数向量,表示动态模式k的神经网络权值常量矩阵的转置。
7.根据权利要求1所述的一种基于动态模式的机械臂智能自主控制方法,其特征在于,步骤4中,所述决策范数为:
<mrow>
<mo>|</mo>
<mo>|</mo>
<msubsup>
<mover>
<mi>x</mi>
<mo>~</mo>
</mover>
<mi>e</mi>
<mi>k</mi>
</msubsup>
<mrow>
<mo>(</mo>
<mi>t</mi>
<mo>)</mo>
</mrow>
<mo>|</mo>
<msub>
<mo>|</mo>
<mn>1</mn>
</msub>
<mo>=</mo>
<mfrac>
<mn>1</mn>
<mi>T</mi>
</mfrac>
<msubsup>
<mo>&Integral;</mo>
<mrow>
<mi>t</mi>
<mo>-</mo>
<mi>T</mi>
</mrow>
<mi>t</mi>
</msubsup>
<mo>|</mo>
<msubsup>
<mover>
<mi>x</mi>
<mo>~</mo>
</mover>
<mi>e</mi>
<mi>k</mi>
</msubsup>
<mrow>
<mo>(</mo>
<mi>v</mi>
<mo>)</mo>
</mrow>
<mo>|</mo>
<mi>d</mi>
<mi>v</mi>
<mo>,</mo>
<mi>t</mi>
<mo>&GreaterEqual;</mo>
<mi>T</mi>
</mrow>
其中,残差 表示第k个动态估计器的状态,xd2表示被测模式的回归轨迹模型的状态,T>0为设计的时间常数。
8.根据权利要求1所述的一种基于动态模式的机械臂智能自主控制方法,其特征在于,步骤5中,所述识别过程的控制器为:
其中,表示模式轨迹的训练域,表示模式轨迹的训练域;当时,控制器τi′采用原控制增益c2,i;当时,控制器τi′采用高控制增益 满足条件其中,z2,i表示控制器τi′的中间误差,表示控制器τi′的神经网络权值常量矩阵的转置,Si(ψi)表示控制器τi′的高斯型径向基函数向量,ψi为控制器τi′的神经网络输入向量。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710636750.1A CN107498554B (zh) | 2017-07-31 | 2017-07-31 | 一种基于动态模式的机械臂智能自主控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710636750.1A CN107498554B (zh) | 2017-07-31 | 2017-07-31 | 一种基于动态模式的机械臂智能自主控制方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN107498554A true CN107498554A (zh) | 2017-12-22 |
CN107498554B CN107498554B (zh) | 2019-10-18 |
Family
ID=60690258
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201710636750.1A Active CN107498554B (zh) | 2017-07-31 | 2017-07-31 | 一种基于动态模式的机械臂智能自主控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN107498554B (zh) |
Cited By (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN109227543A (zh) * | 2018-10-19 | 2019-01-18 | 华南理工大学 | 一种位置受限柔性关节机器人基于模式的智能控制方法 |
CN110083160A (zh) * | 2019-05-16 | 2019-08-02 | 哈尔滨工业大学(深圳) | 一种基于深度学习的机器人轨迹规划方法 |
CN112051733A (zh) * | 2020-08-14 | 2020-12-08 | 华南理工大学 | 一种基于图像分类的刚性机械臂复合学习控制方法 |
CN116619383A (zh) * | 2023-06-21 | 2023-08-22 | 山东大学 | 基于确定学习的机械臂pid控制方法及系统 |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102501251A (zh) * | 2011-11-08 | 2012-06-20 | 北京邮电大学 | 带有动态摩擦补偿的机械臂关节定位控制方法 |
CN102289204B (zh) * | 2011-06-03 | 2013-10-30 | 华南理工大学 | 基于确定学习理论的机械臂通用控制方法 |
CN105835059A (zh) * | 2016-04-29 | 2016-08-10 | 国家电网公司 | 一种机器人控制系统 |
CN106374975A (zh) * | 2016-08-22 | 2017-02-01 | 王毅 | 一种基于多端口的数字化电力线信道模拟设备及模拟方法 |
CN105096615B (zh) * | 2015-07-14 | 2017-05-17 | 安徽四创电子股份有限公司 | 基于信号机的自适应优化控制系统 |
-
2017
- 2017-07-31 CN CN201710636750.1A patent/CN107498554B/zh active Active
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102289204B (zh) * | 2011-06-03 | 2013-10-30 | 华南理工大学 | 基于确定学习理论的机械臂通用控制方法 |
CN102501251A (zh) * | 2011-11-08 | 2012-06-20 | 北京邮电大学 | 带有动态摩擦补偿的机械臂关节定位控制方法 |
CN105096615B (zh) * | 2015-07-14 | 2017-05-17 | 安徽四创电子股份有限公司 | 基于信号机的自适应优化控制系统 |
CN105835059A (zh) * | 2016-04-29 | 2016-08-10 | 国家电网公司 | 一种机器人控制系统 |
CN106374975A (zh) * | 2016-08-22 | 2017-02-01 | 王毅 | 一种基于多端口的数字化电力线信道模拟设备及模拟方法 |
Non-Patent Citations (2)
Title |
---|
杨苹等: "机器人自动装配线监控系统的通信与动态监测", 《华南理工大学学报(自然科学版)》 * |
邱文彬等: "基于在线识别的机器人动态手眼协调", 《机器人》 * |
Cited By (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN109227543A (zh) * | 2018-10-19 | 2019-01-18 | 华南理工大学 | 一种位置受限柔性关节机器人基于模式的智能控制方法 |
CN109227543B (zh) * | 2018-10-19 | 2020-07-28 | 华南理工大学 | 一种位置受限柔性关节机器人基于模式的智能控制方法 |
CN110083160A (zh) * | 2019-05-16 | 2019-08-02 | 哈尔滨工业大学(深圳) | 一种基于深度学习的机器人轨迹规划方法 |
CN112051733A (zh) * | 2020-08-14 | 2020-12-08 | 华南理工大学 | 一种基于图像分类的刚性机械臂复合学习控制方法 |
CN112051733B (zh) * | 2020-08-14 | 2021-08-10 | 华南理工大学 | 一种基于图像分类的刚性机械臂复合学习控制方法 |
CN116619383A (zh) * | 2023-06-21 | 2023-08-22 | 山东大学 | 基于确定学习的机械臂pid控制方法及系统 |
CN116619383B (zh) * | 2023-06-21 | 2024-02-20 | 山东大学 | 基于确定学习的机械臂pid控制方法及系统 |
Also Published As
Publication number | Publication date |
---|---|
CN107498554B (zh) | 2019-10-18 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN107498554A (zh) | 一种基于动态模式的机械臂智能自主控制方法 | |
Nguyen-Tuong et al. | Local gaussian process regression for real-time model-based robot control | |
Khalid et al. | A neural network controller for a temperature control system | |
CN109227543B (zh) | 一种位置受限柔性关节机器人基于模式的智能控制方法 | |
Nazaruddin et al. | PSO based PID controller for quadrotor with virtual sensor | |
Tang et al. | A learning-based framework for robot peg-hole-insertion | |
Nguyen-Tuong et al. | Learning robot dynamics for computed torque control using local Gaussian processes regression | |
Sadeghzadeh et al. | Self-learning visual servoing of robot manipulator using explanation-based fuzzy neural networks and Q-learning | |
Šuster et al. | Tracking trajectory of the mobile robot Khepera II using approaches of artificial intelligence | |
Dimeas et al. | Towards progressive automation of repetitive tasks through physical human-robot interaction | |
CN106687871B (zh) | 用于控制器适应的系统和方法 | |
Qiu et al. | Model predictive control for uncalibrated and constrained image-based visual servoing without joint velocity measurements | |
Le Minh Thanh et al. | Delta robot control using single neuron PID algorithms based on recurrent fuzzy neural network identifiers | |
Wang et al. | A multi-target trajectory planning of a 6-dof free-floating space robot via reinforcement learning | |
CN111223141A (zh) | 基于强化学习的自动化流水线作业效率优化系统及方法 | |
CN111047002A (zh) | 一种基于bp神经网络的校直行程预测方法 | |
Quiros et al. | Object locator and collector robotic arm using artificial neural networks | |
Chen et al. | Learning trajectories for visual-inertial system calibration via model-based heuristic deep reinforcement learning | |
Yu et al. | A robotic auto-focus system based on deep reinforcement learning | |
Hewawasam et al. | Agoraphilic navigation algorithm under dynamic environment | |
Sekaj et al. | Neuro-evolution of mobile robot controller | |
Nishimura et al. | Analyses on on-line evolutionary optimization performance for pose tracking while eye-vergence visual servoing | |
Kružić et al. | Neural Network-based End-effector Force Estimation for Mobile Manipulator on Simulated Uneven Surfaces | |
Franceschi et al. | Predicting human motion intention for phri assistive control | |
Chaouch et al. | A sliding mode based control of 2dof robot manipulator using neural network |
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 |