CN107891424A - 一种求解冗余机械臂逆运动学的有限时间神经网络优化方法 - Google Patents
一种求解冗余机械臂逆运动学的有限时间神经网络优化方法 Download PDFInfo
- Publication number
- CN107891424A CN107891424A CN201711101747.6A CN201711101747A CN107891424A CN 107891424 A CN107891424 A CN 107891424A CN 201711101747 A CN201711101747 A CN 201711101747A CN 107891424 A CN107891424 A CN 107891424A
- Authority
- CN
- China
- Prior art keywords
- mrow
- mover
- msup
- mechanical arm
- theta
- 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
- 238000013528 artificial neural network Methods 0.000 title claims abstract description 16
- 238000005457 optimization Methods 0.000 title claims abstract description 6
- 239000012636 effector Substances 0.000 claims abstract description 30
- 239000011159 matrix material Substances 0.000 claims abstract description 15
- 230000004913 activation Effects 0.000 claims abstract description 8
- 230000015572 biosynthetic process Effects 0.000 claims abstract description 3
- 238000003062 neural network model Methods 0.000 claims abstract description 3
- 238000000034 method Methods 0.000 claims description 9
- 238000006073 displacement reaction Methods 0.000 claims description 6
- 239000013598 vector Substances 0.000 claims description 6
- 238000009795 derivation Methods 0.000 claims description 3
- 230000017105 transposition Effects 0.000 claims description 2
- 230000007935 neutral effect Effects 0.000 description 4
- 238000005516 engineering process Methods 0.000 description 2
- 230000009286 beneficial effect Effects 0.000 description 1
- 238000004364 calculation method Methods 0.000 description 1
- 238000007796 conventional method Methods 0.000 description 1
- 230000007812 deficiency Effects 0.000 description 1
- 238000004519 manufacturing process Methods 0.000 description 1
- 210000004218 nerve net Anatomy 0.000 description 1
- NJPPVKZQTLUDBO-UHFFFAOYSA-N novaluron Chemical compound C1=C(Cl)C(OC(F)(F)C(OC(F)(F)F)F)=CC=C1NC(=O)NC(=O)C1=C(F)C=CC=C1F NJPPVKZQTLUDBO-UHFFFAOYSA-N 0.000 description 1
- 239000003973 paint Substances 0.000 description 1
- 230000000306 recurrent effect Effects 0.000 description 1
- 238000003466 welding Methods 0.000 description 1
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/1607—Calculation of inertia, jacobian matrixes and inverses
-
- 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/1656—Programme controls characterised by programming, planning systems for manipulators
- B25J9/1664—Programme controls characterised by programming, planning systems for manipulators characterised by motion, path, trajectory planning
Landscapes
- Engineering & Computer Science (AREA)
- Robotics (AREA)
- Mechanical Engineering (AREA)
- Physics & Mathematics (AREA)
- Mathematical Physics (AREA)
- Automation & Control Theory (AREA)
- Numerical Control (AREA)
- Manipulator (AREA)
- Feedback Control In General (AREA)
Abstract
一种求解冗余机械臂逆运动学的有限时间神经网络优化方法,包括以下步骤:1)确定冗余机械臂末端执行器期望目标轨迹r*(t)和期望回拢的关节角度θ*(0),将机械臂的末端执行器偏移期望轨迹位置;2)设计终态吸引优化指标,构建基于终态吸引的二次规划方案,其中冗余机械臂实际运动时的初始关节角可以任意指定,给定冗余机械臂实际运动时的初始关节角度θ(0),以θ(0)为运动起始点,形成的重复运动规划方案描述为具终态吸引优化指标的二次规划;3)构建有限值激活函数的终态神经网络模型,有限值终态神经网络求解时变矩阵方程;4)将求解得到的结果用于控制各关节电机,驱动机械臂执行任务。本发明精度高、有限时间收敛。
Description
技术领域
本发明涉及冗余机械臂的重复运动规划及控制技术,具体地,涉及一种有限时间收敛性能指标、在初始偏移情形下的冗余机械臂的逆运动学求解方法。
背景技术
社会的进步,科技的发展,促使人们越来越迫切期望可以从单调重复、复杂繁重和危险恶劣的劳动工作中解放出来,而机械臂(作为二十世纪人类科学技术进步的重大成果之一)的出现则使得这一切逐渐变为现实。一般而言,机械臂是指一个末端能动的机械装置,其末端任务包括搬运、焊接、油漆和组装等;目前已经被广泛应用到工业制造、医学治疗、娱乐服务、消防、军事和太空探索等领域中。并且,根据自由度(degrees-of-freedom,DOF)的多少,机械臂可划分为冗余度机械臂和非冗余度机械臂。冗余度机械臂是指所拥有的DOF多于完成给定末端任务所需的DOF的机械臂。对应地,非冗余度机械臂是指执行给定的末端任务时没有多余DOF的机械臂。显然,较之非冗余度机械臂,冗余度机械臂因其有多余的DOF而更为灵活且更具优势(这也是其在实际工程应用中日益重要的原因之一)。
冗余机械臂在实时运动控制中存在的一个基础问题是冗余度解析问题,又被称作逆运动学。通过已知末端执行器的位置和姿态,求解其对应的冗余机械臂各个关节角的值。经典的做法是基于伪逆的冗余度解析方案。考虑在m维空间中作业的具有n个自由度的机械臂,末端轨迹与关节位移之间的关系(即正运动学问题)
r(t)=f(θ(t))
其中,r(t)表示机械臂末端执行器在工作空间中笛卡尔坐标系下的位移,θ(t)表示关节位移。末端笛卡尔空间与关节空间之间的微分运动关系为
其中,是r的时间导数,是关节速度向量,是机械臂的雅克比矩阵。
对于冗余机械臂,传统方法是求解Moore-Penrose广义逆(伪逆),可得关节变量速度的最小二乘解为
这里,J+=JT(JJT)-1是雅克比矩阵J的伪逆。
末端执行器在笛卡尔操作空间做重复运动时,闭合的末端执行器运动轨迹可能产生非闭合的关节角轨迹,导致关节角偏差现象。这种非重复运动问题可能会引起机械臂在重复作业中出现不可预料的情况。一般来说,应用最为广泛的伪逆控制法不能获得重复性为了完成原有的重复运动。通常采用自运动的方法进行弥补,而自运动进行调整往往效率不高。
发明内容
为了克服现有的冗余机械臂逆运动学求解方法的精度较低、无法实现有限时间收敛的不足,本发明提供一种精度较高、有限时间收敛、易于实现的基于终态吸引优化指标的冗余机械臂轨迹规划方法,以具有有限值激活函数的终态神经网络作为求解器,在初始位置偏移情形下,冗余机械臂各关节角仍然可以回到初始期望位置。
为了解决上述技术问题,本发明提供如下的技术方案:
一种求解冗余机械臂逆运动学的有限时间神经网络优化方法,包括以下步骤:
1)确定冗余机械臂末端执行器期望目标轨迹r*(t)和期望回拢的关节角度θ*(0),使冗余机械臂末端执行器偏移期望轨迹;
2)设计终态吸引优化指标,形成机械臂重复运动规划方案,其中冗余机械臂实际运动时的初始关节角可以任意指定,不要求末端执行器处于期望轨迹上;给定冗余机械臂实际运动时的初始关节角度θ(0),以θ(0)为运动起始点,形成的重复运动规划方案描述为具终态吸引优化指标的二次规划:
其中,θ、分别表示冗余机械臂的关节角度和关节角速度,θ*(0)是各个关节角的期望初始值,βθ>0,1>δ>0是一设计参数,用来形成关节位移的动态性能,θ(t)-θ*(0)表示各个关节角与初始期望关节角位移偏差,r*表示机械臂末端执行器期望的运动轨迹,表示末端执行器期望的速度向量,由于机械臂的初始位置可能不在期望的轨迹上,通过减小末端执行器期望路径与实际运动轨迹位置间的误差(r*-f(θ)),改变末端执行器的运动方向,βr>0表示位置的参数增益,用来调节末端执行器运动到期望路径的速率。J(θ)是冗余机械臂雅可比矩阵,f(θ)是冗余机械臂实际运动轨迹;
3)构建有限值激活函数的终态神经网络模型,其动态特性由下述方程描述
其中,关节角位移偏差E(t)=θ(t)-θ(0),此动态方程所表达的系统有限时间收敛于零,0<δ<1,βE>0,需要的收敛时间T为
在指标函数达到最小值时,冗余机械臂的各个关节角可以回拢到期望的目标轨迹上;
为求解步骤2)中的二次规划,建立拉格朗日函数
式中,λ(t)为拉格朗日乘子向量,λT是λ(t)向量的转置;通过拉格朗日函数对各个变量求导,并令其为零,可得下述时变矩阵方程
WY=v (3)
其中,
I为单位矩阵
记E=WY-v,以式(2)所描述的有限值终态神经网络求解时变矩阵方程(3),得到系统的求解方程如下:
4)将步骤3)中求解得到的结果用于控制各关节电机,驱动机械臂执行任务。
本发明的有益效果主要表现在:本发明提供一种终态吸引优化指标TOC,在初始位置偏移情形下,实现冗余机械臂各个关节角仍然可以回到期望初始位置,实现重复运动规划任务。相对于已有运动规划方法,终态吸引优化指标TOC使得所提方案具有有限时间收敛的特点,有利于提高计算精度。
相比于具有渐近收敛递归神经网络,有限值终态神经网络具有有限时间收敛特性,该终态神经网络求解方法采用的激活函数是有限值激活函数,为相关时变问题求解提供了实时计算工具,并且在实际应用时易于实现。
附图说明
图1为本发明提供的重复规划方案的流程图。
图2为取不同δ值时的终态神经网络激活函数φ(·)。
图3为采用本发明重复规划方案的冗余机械臂ER6B-C60。
图4为冗余机械臂ER6B-C60末端执行器的运动轨迹。
图5为以终态神经网络求解时的误差轨迹。
具体实施方式
下面结合附图对本发明作进一步描述。
参照图1~图5,一种求解冗余机械臂逆运动学的有限时间优化方法,由以下4个步骤组成:1、确定冗余机械臂末端执行器期望目标轨迹和期望回拢各关节角度2、建立具有终态吸引优化指标的冗余机械臂重复运动二次规划方案3、以有限值终态神经网络求解二次规划问题,获得各关节角轨迹。4、将求解得到的结果驱动电机运行,使机械臂完成轨迹任务。
第一步.确定期望轨迹
设定冗余机械臂ER6B-C60期望回拢的关节角度
将目标路径设定为一个边长为1m的正六边形轨迹,确定六边形的轨迹方程。机械臂末端完成正六边形轨迹时间T=9s。其正六边形面与X轴的夹角为π/6rad,设定冗余机械臂ER6B-C60期望回拢的关节角度
θ*(0)=[0,-π/4,0,π/2,-π/4,0]T
考虑到冗余机械臂ER6B-C60的初始位置可能不在期望的运动轨迹上,将机械臂的六个关节角度初值设为θ(0)=[0,-π/4,0,π/2,-π/4+2,0]T。
第二步.建立冗余机械臂重复运动的二次规划方案
为实现冗余机械臂有限时间收敛的重复运动规划,将冗余机械臂重复运动轨迹规划描述为以下二次规划问题,其终态吸引的优化指标为
其中,θ、分别表示冗余机械臂的关节角度和关节角速度,θ*(0)是各个关节角的期望初始值,βθ>0,1>δ>0是一设计参数,用来形成关节位移的动态性能。θ(t)-θ*(0)表示各个关节角与初始期望关节角位移偏差,r*表示机械臂末端执行器期望的运动轨迹,表示末端执行器期望的速度向量。由于机械臂的初始位置可能不在期望的轨迹上,通过减小末端执行器期望路径与实际运动轨迹位置间的误差(r*-f(θ)),改变末端执行器的运动方向,βr>0表示位置的参数增益,用来调节末端执行器运动到期望路径的速率。J(θ)是冗余机械臂雅可比矩阵,f(θ)是冗余机械臂实际运动轨迹。
第三步.以有限值终态神经网络求解上述二次规划问题
通过对拉格朗日函数各个变量求导,并令其为零,可得如下时变矩阵方程
WY=v
I为单位矩阵
记时变矩阵方程误差E=WY-v。依据有限值终态神经网络动态方程(2)构建神经网络模型
第四步,将第三步中求解得到的结果用于控制各关节电机,驱动机械臂执行任务。
图2为取不同δ值的终态神经网络激活函数。从图中可以看出,δ的取值在0和1之间,在图中分别取δ=0.1,0.2,0.4,0.6,0.8,随着δ的增大,曲线的在零点附近的收敛速度越慢。
用于实现本发明重复规划方案的冗余机械臂ER6B-C60如图3所示。该机械臂由1个基座,6个连接杆构成,通过关节a1、关节a2、关节a3、关节a4、关节a5、关节a6组成。该冗余机械臂如图连杆长度分别为L1=0.563米,L2=0.9米,L3=0.16米,L4=1.0135米,L5=0.195米,,L6=0.22米。
机械臂的末端执行器在空间中的运动轨迹如图4所示。图中给出目标正六边形轨迹及机械臂末端执行器运动轨迹。可以看出,末端执行器的初始位置不在期望的轨迹上。随着时间的增加,实际轨迹和期望轨迹吻合。
定义计算误差JE(t)=||W(t)y(t)-v(t)||2。图5给出用有限值终态神经网络求解二次规划问题的误差收敛轨迹。从图中可以看出,以有限值终态神经网络求解时,当时间t接近0.01秒时,误差收敛精度达到0.3*10-3。
Claims (1)
1.一种求解冗余机械臂逆运动学的有限时间神经网络优化方法,其特征在于:包括以下步骤:
1)确定冗余机械臂末端执行器期望轨迹方程r*(t),设定期望回拢的关节角度θ*(0),使冗余机械臂末端执行器偏移期望轨迹;
2)设计终态吸引优化指标,形成机械臂重复运动二次规划方案,其中冗余机械臂实际运动时的初始关节角可以任意指定,不要求末端执行器处于期望轨迹上;给定冗余机械臂实际运动时的初始关节角度θ(0),以θ(0)为运动起始点,形成的重复运动规划方案描述为具终态吸引优化指标的二次规划:
<mrow>
<mtable>
<mtr>
<mtd>
<munder>
<mrow>
<mi>min</mi>
<mi>i</mi>
<mi>m</mi>
<mi>i</mi>
<mi>z</mi>
<mi>e</mi>
</mrow>
<mrow>
<mover>
<mi>&theta;</mi>
<mo>&CenterDot;</mo>
</mover>
<mrow>
<mo>(</mo>
<mi>t</mi>
<mo>)</mo>
</mrow>
</mrow>
</munder>
</mtd>
<mtd>
<mrow>
<mfrac>
<mn>1</mn>
<mn>2</mn>
</mfrac>
<msup>
<mrow>
<mo>(</mo>
<mover>
<mi>&theta;</mi>
<mo>&CenterDot;</mo>
</mover>
<mo>(</mo>
<mi>t</mi>
<mo>)</mo>
<mo>+</mo>
<msub>
<mi>&beta;</mi>
<mi>&theta;</mi>
</msub>
<mi>c</mi>
<mo>)</mo>
</mrow>
<mi>T</mi>
</msup>
<mrow>
<mo>(</mo>
<mover>
<mi>&theta;</mi>
<mo>&CenterDot;</mo>
</mover>
<mo>(</mo>
<mi>t</mi>
<mo>)</mo>
<mo>+</mo>
<msub>
<mi>&beta;</mi>
<mi>&theta;</mi>
</msub>
<mi>c</mi>
<mo>)</mo>
</mrow>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<mi>s</mi>
<mi>u</mi>
<mi>b</mi>
<mi>j</mi>
<mi>e</mi>
<mi>c</mi>
<mi>t</mi>
<mi> </mi>
<mi>t</mi>
<mi>o</mi>
</mrow>
</mtd>
<mtd>
<mrow>
<mi>J</mi>
<mrow>
<mo>(</mo>
<mi>&theta;</mi>
<mo>)</mo>
</mrow>
<mover>
<mi>&theta;</mi>
<mo>&CenterDot;</mo>
</mover>
<mo>=</mo>
<msup>
<mover>
<mi>r</mi>
<mo>&CenterDot;</mo>
</mover>
<mo>*</mo>
</msup>
<mo>+</mo>
<msub>
<mi>&beta;</mi>
<mi>r</mi>
</msub>
<mrow>
<mo>(</mo>
<msup>
<mi>r</mi>
<mo>*</mo>
</msup>
<mo>-</mo>
<mi>f</mi>
<mo>(</mo>
<mi>&theta;</mi>
<mo>)</mo>
<mo>)</mo>
</mrow>
</mrow>
</mtd>
</mtr>
</mtable>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>1</mn>
<mo>)</mo>
</mrow>
</mrow>
其中,θ、分别表示冗余机械臂的关节角度和关节角速度,θ*(0)是各个关节角的期望初始值,βθ>0,1>δ>0是一设计参数,用来形成关节位移的动态性能,θ(t)-θ*(0)表示各个关节角与初始期望关节角位移偏差,r*表示机械臂末端执行器期望的运动轨迹,表示末端执行器期望的速度向量,由于机械臂的初始位置可能不在期望的轨迹上,通过减小末端执行器期望路径与实际运动轨迹位置间的误差(r*-f(θ)),改变末端执行器的运动方向,βr>0表示位置的参数增益,用来调节末端执行器运动到期望路径的速率,J(θ)是冗余机械臂雅可比矩阵,f(θ)是冗余机械臂实际运动轨迹;
3)构建有限值激活函数的终态神经网络模型,其动态特性由下述方程描述
<mrow>
<mover>
<mi>E</mi>
<mo>&CenterDot;</mo>
</mover>
<mo>=</mo>
<mo>-</mo>
<msub>
<mi>&beta;</mi>
<mi>E</mi>
</msub>
<mi>a</mi>
<mi>r</mi>
<mi>cosh</mi>
<mrow>
<mo>(</mo>
<mfrac>
<mrow>
<mo>|</mo>
<mi>E</mi>
<mrow>
<mo>(</mo>
<mi>t</mi>
<mo>)</mo>
</mrow>
<mo>|</mo>
</mrow>
<mi>&delta;</mi>
</mfrac>
<mo>+</mo>
<mn>1</mn>
<mo>)</mo>
</mrow>
<mi>sgn</mi>
<mrow>
<mo>(</mo>
<mi>E</mi>
<mo>(</mo>
<mi>t</mi>
<mo>)</mo>
<mo>)</mo>
</mrow>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>2</mn>
<mo>)</mo>
</mrow>
</mrow>
其中,关节角位移偏差E(t)=θ(t)-θ(0),此动态方程所表达的系统有限时间收敛于零,0<δ<1,βE>0,需要的收敛时间T为
<mrow>
<mi>T</mi>
<mo>=</mo>
<mo>-</mo>
<msub>
<mi>&beta;</mi>
<mi>E</mi>
</msub>
<mrow>
<mo>(</mo>
<mfrac>
<mrow>
<mo>|</mo>
<mi>E</mi>
<mrow>
<mo>(</mo>
<mn>0</mn>
<mo>)</mo>
</mrow>
<mo>|</mo>
</mrow>
<mi>&delta;</mi>
</mfrac>
<mo>+</mo>
<mn>1</mn>
<mo>)</mo>
</mrow>
<mi>l</mi>
<mi>n</mi>
<mrow>
<mo>(</mo>
<mo>(</mo>
<mrow>
<mfrac>
<mrow>
<mo>|</mo>
<mi>E</mi>
<mrow>
<mo>(</mo>
<mn>0</mn>
<mo>)</mo>
</mrow>
<mo>|</mo>
</mrow>
<mi>&delta;</mi>
</mfrac>
<mo>+</mo>
<mn>1</mn>
</mrow>
<mo>)</mo>
<mo>+</mo>
<msqrt>
<mrow>
<msup>
<mrow>
<mo>(</mo>
<mfrac>
<mrow>
<mo>|</mo>
<mi>E</mi>
<mrow>
<mo>(</mo>
<mn>0</mn>
<mo>)</mo>
</mrow>
<mo>|</mo>
</mrow>
<mi>&delta;</mi>
</mfrac>
<mo>+</mo>
<mn>1</mn>
<mo>)</mo>
</mrow>
<mn>2</mn>
</msup>
<mo>-</mo>
<mn>1</mn>
</mrow>
</msqrt>
<mo>)</mo>
</mrow>
<mo>+</mo>
<mfrac>
<mn>1</mn>
<mn>3</mn>
</mfrac>
<msup>
<mrow>
<mo>(</mo>
<msup>
<mrow>
<mo>(</mo>
<mrow>
<mfrac>
<mrow>
<mo>|</mo>
<mi>E</mi>
<mrow>
<mo>(</mo>
<mn>0</mn>
<mo>)</mo>
</mrow>
<mo>|</mo>
</mrow>
<mi>&delta;</mi>
</mfrac>
<mo>+</mo>
<mn>1</mn>
</mrow>
<mo>)</mo>
</mrow>
<mn>2</mn>
</msup>
<mo>-</mo>
<mn>1</mn>
<mo>)</mo>
</mrow>
<mfrac>
<mn>3</mn>
<mn>2</mn>
</mfrac>
</msup>
</mrow>
在指标函数达到最小值时,冗余机械臂的各个关节角可以回拢到期望的目标轨迹上;
为求解步骤2)中的二次规划,建立拉格朗日函数
<mrow>
<mi>L</mi>
<mrow>
<mo>(</mo>
<mover>
<mi>&theta;</mi>
<mo>&CenterDot;</mo>
</mover>
<mo>(</mo>
<mi>t</mi>
<mo>)</mo>
<mo>,</mo>
<mi>&lambda;</mi>
<mo>(</mo>
<mi>t</mi>
<mo>)</mo>
<mo>,</mo>
<mi>t</mi>
<mo>)</mo>
</mrow>
<mo>=</mo>
<mover>
<mi>&theta;</mi>
<mo>&CenterDot;</mo>
</mover>
<msup>
<mrow>
<mo>(</mo>
<mi>t</mi>
<mo>)</mo>
</mrow>
<mi>T</mi>
</msup>
<mover>
<mi>&theta;</mi>
<mo>&CenterDot;</mo>
</mover>
<mrow>
<mo>(</mo>
<mi>t</mi>
<mo>)</mo>
</mrow>
<mo>/</mo>
<mn>2</mn>
<mo>+</mo>
<msup>
<mi>c</mi>
<mi>T</mi>
</msup>
<mover>
<mi>&theta;</mi>
<mo>&CenterDot;</mo>
</mover>
<mo>+</mo>
<mi>&lambda;</mi>
<msup>
<mrow>
<mo>(</mo>
<mi>t</mi>
<mo>)</mo>
</mrow>
<mi>T</mi>
</msup>
<mrow>
<mo>(</mo>
<mi>J</mi>
<mo>(</mo>
<mi>&theta;</mi>
<mo>)</mo>
<mover>
<mi>&theta;</mi>
<mo>&CenterDot;</mo>
</mover>
<mo>-</mo>
<msup>
<mover>
<mi>r</mi>
<mo>&CenterDot;</mo>
</mover>
<mo>*</mo>
</msup>
<mo>-</mo>
<msub>
<mi>&beta;</mi>
<mi>r</mi>
</msub>
<mo>(</mo>
<mrow>
<msup>
<mi>r</mi>
<mo>*</mo>
</msup>
<mo>-</mo>
<mi>f</mi>
<mrow>
<mo>(</mo>
<mi>&theta;</mi>
<mo>)</mo>
</mrow>
</mrow>
<mo>)</mo>
<mo>)</mo>
</mrow>
</mrow>
式中,λ(t)为拉格朗日乘子向量,λT是λ(t)向量的转置;通过拉格朗日函数对各个变量求导,并令其为零,可得下述时变矩阵方程
WY=v (3)
其中,
I为单位矩阵
<mrow>
<mi>Y</mi>
<mo>=</mo>
<mfenced open = "[" close = "]">
<mtable>
<mtr>
<mtd>
<mover>
<mi>&theta;</mi>
<mo>&CenterDot;</mo>
</mover>
</mtd>
</mtr>
<mtr>
<mtd>
<mi>&lambda;</mi>
</mtd>
</mtr>
</mtable>
</mfenced>
<mo>,</mo>
</mrow>
<mrow>
<mi>v</mi>
<mrow>
<mo>(</mo>
<mi>t</mi>
<mo>)</mo>
</mrow>
<mo>=</mo>
<msup>
<mrow>
<mo>&lsqb;</mo>
<msub>
<mi>&beta;</mi>
<mi>&theta;</mi>
</msub>
<mi>a</mi>
<mi>r</mi>
<mi>c</mi>
<mi>o</mi>
<mi>s</mi>
<mi>h</mi>
<mrow>
<mo>(</mo>
<mfrac>
<mrow>
<mo>|</mo>
<mi>&theta;</mi>
<mrow>
<mo>(</mo>
<mi>t</mi>
<mo>)</mo>
</mrow>
<mo>-</mo>
<msup>
<mi>&theta;</mi>
<mo>*</mo>
</msup>
<mrow>
<mo>(</mo>
<mn>0</mn>
<mo>)</mo>
</mrow>
<mo>|</mo>
</mrow>
<mi>&delta;</mi>
</mfrac>
<mo>+</mo>
<mn>1</mn>
<mo>)</mo>
</mrow>
<mi>sgn</mi>
<mrow>
<mo>(</mo>
<mi>&theta;</mi>
<mo>(</mo>
<mi>t</mi>
<mo>)</mo>
<mo>-</mo>
<msup>
<mi>&theta;</mi>
<mo>*</mo>
</msup>
<mo>(</mo>
<mn>0</mn>
<mo>)</mo>
<mo>)</mo>
</mrow>
<mo>,</mo>
<mover>
<mi>r</mi>
<mo>&CenterDot;</mo>
</mover>
<mo>+</mo>
<msub>
<mi>&beta;</mi>
<mi>r</mi>
</msub>
<mrow>
<mo>(</mo>
<mi>r</mi>
<mo>-</mo>
<mi>f</mi>
<mo>(</mo>
<mi>&theta;</mi>
<mo>)</mo>
<mo>)</mo>
</mrow>
<mo>&rsqb;</mo>
</mrow>
<mi>T</mi>
</msup>
</mrow>
记E=WY-v,以式(2)所描述的有限值终态神经网络求解时变矩阵方程(3),得到系统的求解方程如下
<mrow>
<mtable>
<mtr>
<mtd>
<mrow>
<mover>
<mi>Y</mi>
<mo>&CenterDot;</mo>
</mover>
<mrow>
<mo>(</mo>
<mi>t</mi>
<mo>)</mo>
</mrow>
<mo>=</mo>
<mo>-</mo>
<mover>
<mi>W</mi>
<mo>&CenterDot;</mo>
</mover>
<mrow>
<mo>(</mo>
<mi>t</mi>
<mo>)</mo>
</mrow>
<mi>Y</mi>
<mrow>
<mo>(</mo>
<mi>t</mi>
<mo>)</mo>
</mrow>
<mo>-</mo>
<mi>W</mi>
<mrow>
<mo>(</mo>
<mi>t</mi>
<mo>)</mo>
</mrow>
<mover>
<mi>Y</mi>
<mo>&CenterDot;</mo>
</mover>
<mrow>
<mo>(</mo>
<mi>t</mi>
<mo>)</mo>
</mrow>
<mo>+</mo>
<mover>
<mi>v</mi>
<mo>&CenterDot;</mo>
</mover>
<mrow>
<mo>(</mo>
<mi>t</mi>
<mo>)</mo>
</mrow>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<mo>+</mo>
<msub>
<mi>&beta;</mi>
<mi>E</mi>
</msub>
<mi>a</mi>
<mi>r</mi>
<mi>cosh</mi>
<mrow>
<mo>(</mo>
<mfrac>
<mrow>
<mo>|</mo>
<mi>W</mi>
<mrow>
<mo>(</mo>
<mi>t</mi>
<mo>)</mo>
</mrow>
<mi>Y</mi>
<mrow>
<mo>(</mo>
<mi>t</mi>
<mo>)</mo>
</mrow>
<mo>-</mo>
<mi>v</mi>
<mrow>
<mo>(</mo>
<mi>t</mi>
<mo>)</mo>
</mrow>
<mo>|</mo>
</mrow>
<mi>&delta;</mi>
</mfrac>
<mo>+</mo>
<mn>1</mn>
<mo>)</mo>
</mrow>
<mi>sgn</mi>
<mrow>
<mo>(</mo>
<mi>W</mi>
<mo>(</mo>
<mi>t</mi>
<mo>)</mo>
<mi>Y</mi>
<mo>(</mo>
<mi>t</mi>
<mo>)</mo>
<mo>-</mo>
<mi>v</mi>
<mo>(</mo>
<mi>t</mi>
<mo>)</mo>
<mo>)</mo>
</mrow>
<mo>+</mo>
<mover>
<mi>Y</mi>
<mo>&CenterDot;</mo>
</mover>
<mrow>
<mo>(</mo>
<mi>t</mi>
<mo>)</mo>
</mrow>
</mrow>
</mtd>
</mtr>
</mtable>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>4</mn>
<mo>)</mo>
</mrow>
</mrow>
4)将步骤3)中求解得到的结果用于控制各关节电机,驱动机械臂执行任务。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201711101747.6A CN107891424B (zh) | 2017-11-10 | 2017-11-10 | 求解冗余机械臂逆运动学的有限时间神经网络优化方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201711101747.6A CN107891424B (zh) | 2017-11-10 | 2017-11-10 | 求解冗余机械臂逆运动学的有限时间神经网络优化方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN107891424A true CN107891424A (zh) | 2018-04-10 |
CN107891424B CN107891424B (zh) | 2020-08-25 |
Family
ID=61804884
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201711101747.6A Active CN107891424B (zh) | 2017-11-10 | 2017-11-10 | 求解冗余机械臂逆运动学的有限时间神经网络优化方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN107891424B (zh) |
Cited By (15)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN108908347A (zh) * | 2018-09-07 | 2018-11-30 | 浙江科技学院 | 一种面向冗余移动机械臂容错型重复运动规划方法 |
CN108908341A (zh) * | 2018-08-03 | 2018-11-30 | 浙江工业大学 | 基于二次根式终态吸引性能指标的冗余机器人重复运动规划方法 |
CN108908340A (zh) * | 2018-08-03 | 2018-11-30 | 浙江工业大学 | 采用有限区间神经网络的冗余机器人重复运动规划方法 |
CN109015657A (zh) * | 2018-09-07 | 2018-12-18 | 浙江科技学院 | 一种面向冗余机械臂重复运动规划的终态网络优化方法 |
CN109048911A (zh) * | 2018-08-31 | 2018-12-21 | 河南工程学院 | 一种基于矩形特征的机器人视觉控制方法 |
CN109940615A (zh) * | 2019-03-13 | 2019-06-28 | 浙江科技学院 | 一种面向双臂机械手同步重复运动规划的终态网络优化方法 |
CN110489707A (zh) * | 2019-08-22 | 2019-11-22 | 苏州科技大学 | 一种基于gan网络的机器人逆运动学求解方法 |
CN111890363A (zh) * | 2020-07-27 | 2020-11-06 | 四川大学 | 一种基于快速自适应梯度神经网络算法的机械臂运动规划方法 |
CN112706163A (zh) * | 2020-12-10 | 2021-04-27 | 中山大学 | 一种机械臂运动控制方法、装置、设备及介质 |
CN112847351A (zh) * | 2020-12-31 | 2021-05-28 | 重庆电子工程职业学院 | 一种基于指数趋近率的并联机器人轨迹跟踪控制方法 |
CN113084803A (zh) * | 2021-03-31 | 2021-07-09 | 信阳师范学院 | 一种基于多层结构的冗余度机械臂多任务控制方法 |
CN114211500A (zh) * | 2021-12-31 | 2022-03-22 | 华南理工大学 | 一种自适应模糊神经网络的规划方法 |
CN114734435A (zh) * | 2022-03-24 | 2022-07-12 | 苏州艾利特机器人有限公司 | 一种基于超球面的编码器校准方法、装置及系统 |
CN114800477A (zh) * | 2022-05-25 | 2022-07-29 | 华东交通大学 | 基于最小流量的冗余液压机械臂运动规划方法 |
CN116117825A (zh) * | 2023-04-04 | 2023-05-16 | 人工智能与数字经济广东省实验室(广州) | 一种基于抗噪声模糊递归神经网络的fpga实现方法 |
Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH0811076A (ja) * | 1994-06-30 | 1996-01-16 | Hitachi Constr Mach Co Ltd | 把持装置 |
CN1598719A (zh) * | 2004-09-27 | 2005-03-23 | 北京交通大学 | 一种神经网络优化控制器及控制方法 |
CN106985138A (zh) * | 2017-03-13 | 2017-07-28 | 浙江工业大学 | 基于终态吸引优化指标的冗余机械臂轨迹规划方法 |
CN107127754A (zh) * | 2017-05-09 | 2017-09-05 | 浙江工业大学 | 一种基于终态吸引优化指标的冗余机械臂重复运动规划方法 |
-
2017
- 2017-11-10 CN CN201711101747.6A patent/CN107891424B/zh active Active
Patent Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH0811076A (ja) * | 1994-06-30 | 1996-01-16 | Hitachi Constr Mach Co Ltd | 把持装置 |
CN1598719A (zh) * | 2004-09-27 | 2005-03-23 | 北京交通大学 | 一种神经网络优化控制器及控制方法 |
CN106985138A (zh) * | 2017-03-13 | 2017-07-28 | 浙江工业大学 | 基于终态吸引优化指标的冗余机械臂轨迹规划方法 |
CN107127754A (zh) * | 2017-05-09 | 2017-09-05 | 浙江工业大学 | 一种基于终态吸引优化指标的冗余机械臂重复运动规划方法 |
Non-Patent Citations (1)
Title |
---|
余轩峰: "有限时间收敛神经网络及其相关应用", 《中国优秀硕士学位论文全文数据库 信息科技辑》 * |
Cited By (25)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN108908340B (zh) * | 2018-08-03 | 2020-08-04 | 浙江工业大学 | 采用有限区间神经网络的冗余机器人重复运动规划方法 |
CN108908341A (zh) * | 2018-08-03 | 2018-11-30 | 浙江工业大学 | 基于二次根式终态吸引性能指标的冗余机器人重复运动规划方法 |
CN108908340A (zh) * | 2018-08-03 | 2018-11-30 | 浙江工业大学 | 采用有限区间神经网络的冗余机器人重复运动规划方法 |
CN108908341B (zh) * | 2018-08-03 | 2021-01-01 | 浙江工业大学 | 二次根式终态吸引的冗余机器人重复运动规划方法 |
CN109048911B (zh) * | 2018-08-31 | 2021-08-24 | 河南工程学院 | 一种基于矩形特征的机器人视觉控制方法 |
CN109048911A (zh) * | 2018-08-31 | 2018-12-21 | 河南工程学院 | 一种基于矩形特征的机器人视觉控制方法 |
CN108908347A (zh) * | 2018-09-07 | 2018-11-30 | 浙江科技学院 | 一种面向冗余移动机械臂容错型重复运动规划方法 |
CN109015657A (zh) * | 2018-09-07 | 2018-12-18 | 浙江科技学院 | 一种面向冗余机械臂重复运动规划的终态网络优化方法 |
CN109015657B (zh) * | 2018-09-07 | 2021-12-10 | 浙江科技学院 | 一种面向冗余机械臂重复运动规划的终态网络优化方法 |
CN109940615A (zh) * | 2019-03-13 | 2019-06-28 | 浙江科技学院 | 一种面向双臂机械手同步重复运动规划的终态网络优化方法 |
CN110489707A (zh) * | 2019-08-22 | 2019-11-22 | 苏州科技大学 | 一种基于gan网络的机器人逆运动学求解方法 |
CN110489707B (zh) * | 2019-08-22 | 2023-08-25 | 苏州科技大学 | 一种基于gan网络的机器人逆运动学求解方法 |
CN111890363A (zh) * | 2020-07-27 | 2020-11-06 | 四川大学 | 一种基于快速自适应梯度神经网络算法的机械臂运动规划方法 |
CN112706163A (zh) * | 2020-12-10 | 2021-04-27 | 中山大学 | 一种机械臂运动控制方法、装置、设备及介质 |
CN112706163B (zh) * | 2020-12-10 | 2022-03-04 | 中山大学 | 一种机械臂运动控制方法、装置、设备及介质 |
CN112847351A (zh) * | 2020-12-31 | 2021-05-28 | 重庆电子工程职业学院 | 一种基于指数趋近率的并联机器人轨迹跟踪控制方法 |
CN113084803A (zh) * | 2021-03-31 | 2021-07-09 | 信阳师范学院 | 一种基于多层结构的冗余度机械臂多任务控制方法 |
CN114211500B (zh) * | 2021-12-31 | 2023-05-30 | 华南理工大学 | 一种自适应模糊神经网络的规划方法 |
CN114211500A (zh) * | 2021-12-31 | 2022-03-22 | 华南理工大学 | 一种自适应模糊神经网络的规划方法 |
CN114734435A (zh) * | 2022-03-24 | 2022-07-12 | 苏州艾利特机器人有限公司 | 一种基于超球面的编码器校准方法、装置及系统 |
CN114734435B (zh) * | 2022-03-24 | 2023-09-19 | 苏州艾利特机器人有限公司 | 一种基于超球面的编码器校准方法、装置及系统 |
CN114800477A (zh) * | 2022-05-25 | 2022-07-29 | 华东交通大学 | 基于最小流量的冗余液压机械臂运动规划方法 |
CN114800477B (zh) * | 2022-05-25 | 2023-03-14 | 华东交通大学 | 基于最小流量的冗余液压机械臂运动规划方法 |
CN116117825A (zh) * | 2023-04-04 | 2023-05-16 | 人工智能与数字经济广东省实验室(广州) | 一种基于抗噪声模糊递归神经网络的fpga实现方法 |
CN116117825B (zh) * | 2023-04-04 | 2023-08-08 | 人工智能与数字经济广东省实验室(广州) | 一种基于抗噪声模糊递归神经网络的fpga实现方法 |
Also Published As
Publication number | Publication date |
---|---|
CN107891424B (zh) | 2020-08-25 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN107891424A (zh) | 一种求解冗余机械臂逆运动学的有限时间神经网络优化方法 | |
CN107972031A (zh) | 一种冗余机械臂可重复运动的初始位置定位方法 | |
CN107962566A (zh) | 一种移动机械臂重复运动规划方法 | |
CN106985138B (zh) | 基于终态吸引优化指标的冗余机械臂轨迹规划方法 | |
WO2018176854A1 (zh) | 一种冗余度机械臂重复运动规划方法 | |
CN107127754A (zh) | 一种基于终态吸引优化指标的冗余机械臂重复运动规划方法 | |
CN107972030A (zh) | 一种冗余机械臂重复运动中的初始位置修正方法 | |
CN108241339A (zh) | 仿人机械臂的运动求解和构型控制方法 | |
CN108908347A (zh) | 一种面向冗余移动机械臂容错型重复运动规划方法 | |
CN107490965A (zh) | 一种空间自由漂浮机械臂的多约束轨迹规划方法 | |
CN104760041B (zh) | 一种基于突加度的障碍物躲避运动规划方法 | |
CN108015766B (zh) | 一种非线性约束的原对偶神经网络机器人动作规划方法 | |
CN105598968B (zh) | 一种并联机械臂的运动规划与控制方法 | |
CN107263466A (zh) | 空间机器人基于二次规划问题的基座无扰控制方法 | |
CN109940615A (zh) | 一种面向双臂机械手同步重复运动规划的终态网络优化方法 | |
CN107160401A (zh) | 一种解决冗余度机械臂关节角偏移问题的方法 | |
CN109991847A (zh) | 一种柔性多体机器人近似时间最优轨迹规划方法 | |
CN112936287A (zh) | 一种基于动力学迭代学习的柔性机器人控制方法及装置 | |
Xu et al. | Non-holonomic path planning of a free-floating space robotic system using genetic algorithms | |
CN109015657A (zh) | 一种面向冗余机械臂重复运动规划的终态网络优化方法 | |
Zhou et al. | Design and kinematic of a dexterous bioinspired elephant trunk robot with variable diameter | |
JPH0683427A (ja) | 柔軟マニピュレータの作業点位置制御システム | |
Lee et al. | Control of impact disturbance by redundantly actuated mechanism | |
Miller | Dynamics of the new UWA robot | |
Kim et al. | Forward kinematic singularity avoiding design of a schönflies motion generator by asymmetric attachment of subchains |
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 |