基于对偶神经网络的危化品运输机械臂末端精确定位方法技术

一种基于对偶神经网络的危化品运输机械臂末端精确定位方法，考虑到危化品运输机械臂运动过程中自身关节角度约束和末端执行器初始位置不确定性，对偶神经网络模型具有有限时间收敛性，不仅能够改进收敛速度，而且达到较高收敛精度，最终使得所有的关节在有限的时间内回拢到初始期望位置，实现重复任务。本发明专利技术的整个危化品运输机械臂运动系统具有更好的位置误差收敛性和稳态特性。位置误差收敛性和稳态特性。位置误差收敛性和稳态特性。

【技术实现步骤摘要】
基于对偶神经网络的危化品运输机械臂末端精确定位方法


[0001]本专利技术涉及一种基于对偶神经网络的危化品运输机械臂末端定位方法，特别是带有关节角度约束以及初始位置偏移情况下的危化品运输机械臂末端控制方法。

技术介绍

[0002]危险品运输机械手臂作为一种特殊功能的机械臂，通过控制器调控机械臂的运动轨迹，完成复杂危险的重复任务。危险品运输机械臂是拟人手臂、手腕和手功能的机械电子装置，其末端任务包括搬运、焊接、组装等，一个机械手臂一般拥有3个或3个以上的旋转自由度，在用机械手臂去完成某个特定的工作时，因其拥有多余的旋转自由度，这种特殊用途的机械手臂才拥有更大的操作空间，比如物理极限躲避和环境障碍物躲避。
[0003]递归神经网络被广泛应用于时变问题的求解，相比与传统的解决方法，神经网络在求解过程中具有较高的收敛性和有限时间。传统的神经网络应用于机械臂重复运动轨迹规划时，无法克服机械臂自身的关节物理极限，即使能够实现在有限的时间内收敛。为了解决这一问题，提出了基于有限时间对偶神经网络。该神经网络在求解带等式约束的时变计算问题时既能够实现有限时间收敛又能够克服机械臂的关节角度约束问题。
[0004]危化品运输机械臂在运动过程中，存在自身关节角度约束及初始位置的不确定性。当末端执行器的运动轨迹是闭合的，在机械臂完成末端工作任务后，各个关节角变量在运动空间中的轨迹不一定封闭。这种非重复性问题可能产生不期望的关节位形，使得该类型机械臂末端封闭轨迹的重复作业出现预料之外的情况，甚至会导致意外及危险情况的发生。因此在传统的神经网络的基础上，设计一种对偶神经网络来对危化品运输机械臂的运动轨迹进行有效进行规划。

技术实现思路

[0005]为了克服现有技术的不足，考虑到危化品运输机械臂运动过程中自身关节角度约束和末端执行器初始位置不确定性，本专利技术提供了一种基于对偶神经网络的危化品运输机械臂运动规划方法，使得所有的关节在有限的时间内回拢到初始期望位置，实现重复任务，该对偶神经网络模型具有有限时间收敛性，不仅能够改进收敛速度，而且达到较高收敛精度。
[0006]为了解决上述技术问题，本专利技术提供如下的技术方案：
[0007]一种基于对偶神经网络的危化品运输机械臂末端精确定位方法，包括以下步骤：
[0008]步骤1，建立危化品运输机械臂末端执行器期望目标轨迹r
d
和期望回拢的关节角度θ
*
(0)，建立起危化品运输机械臂的运动学方程，通过D
‑
H(Denavit
‑
Hartenberg)参数法来描述相邻连杆之间的坐标方向和参数，危化品运输机械臂各关节及杆是刚性物体，对危化品运输机械臂各关节进行分析，建立全局坐标系与局部坐标系，全局坐标系是基于地面的坐标系，局部坐标系是根据D
‑
H参数建立的参考坐标系，通过局部坐标系中各关节角的齐次变换矩阵T
i
‑
1i
，得到危化品运输机械臂末端执行器在全局坐标系中的位置；
[0009]步骤2，建立危化品运输机械臂末端执行器方向向量r(t)∈R
n
与关节角向量θ(t)∈R
m
之间的运动关系；
[0010]步骤3，构建带约束条件的重复运动二次规划方案；
[0011]步骤4，构建对偶神经网络求解模型。
[0012]进一步，所述步骤1中，齐次变换矩阵T
i
‑
1i
如下：
[0013][0014]其中θ
i
,α
i
,a
i
和d
i
分别代表机械臂第i关节的运动关节角，连杆转角，连杆长度和连杆偏距；计算出PA10机械臂各关节间的变换矩阵T
01
～T
67
，将这些变换矩阵相乘得到末端执行器相对于基坐标系的齐次变换矩阵，具体表示如下：
[0015][0016]其中，n∈R3是末端执行器在基坐标系中的法向量，s∈R3、a∈R3和p＝[p
x
,p
y
,p
z
]T
分别是末端执行器的滑动向量、逼近向量和位置向量，那么PA10机械臂的末端执行器的位置向量r(t)∈R3与关节角向量θ(t)∈R7的关系如下式：
[0017]r(t)＝f(θ(t))＝[p
x p
y p
z
]T
ꢀꢀ
(3)
[0018]对上述等式进行微分处理，从而计算出危化品运输机械臂的雅可比矩阵，如下：
[0019][0020]再进一步，所述步骤2中，运动关系表达式如下：
[0021]g(θ(t))＝r(t)
ꢀꢀ
(5)
[0022]其中：g(
·
):R
m
→
R
n
是一个非线性连续函数映射；
[0023]所述步骤2的过程如下：
[0024]2.1定义速度层优化性能指标
[0025]为实现运动任务目标，通过最小化关节当前位置与初始位置之间的位移量来消除关节角偏差，所得到的速度层优化性能指标描述如下：
[0026][0027]其中：θ(0)∈R
m
是关节角变量的初始值；β＞0是用来调节关节位移幅值的设计参数，由于等式(6)中a为决定变量，则a相对于是个常量，因此，所需优化的性能指标进一步转化为
[0028][0029]2.2建立危化品运输机械臂自身的关节物理约束，形成带约束的最小优化方案，该类型机械臂自身的关节物理极限，即
[0030][0031]其中：θ
±
和分别为关节角向量θ(t)和关节速度向量的上下界，将等式(8)转化成速度层得到：
[0032][0033]其中：∈＞0是用来调节关节速度的可行域，将等式(8)与等式(9)相结合，针对的不等式约束进一步转化为
[0034][0035]其中η
‑
和η
+
的第i个元素分别表示为
[0036][0037]基于上述分析，带有关节物理约束的危化品运输机械臂运动规划问题描述为如下带约束的时变二次规划问题：
[0038][0039]更进一步，所述步骤3中，基于步骤2中带约束的问题(12)，令等式(12)中得到如下带约束条件的重复运动二次规划方案：
[0040][0041]其中：M＝I，I为m维单位矩阵，J是行满秩矩阵，即rank(J)＝n。
[0042]所述步骤4中，根据Karush
‑
Kuhn
‑
Tucker(KKT)条件可知，带约束的重复运动规划方案(13)的最优解也应当满足下述情况：
[0043][0044]其中：γ∈R
n
和μ∈R
m
分别为等式约束(13)的对偶变量；
[0045]通本文档来自技高网...

【技术保护点】

【技术特征摘要】
1.一种基于对偶神经网络的危化品运输机械臂末端精确定位方法，其特征在于，所述方法包括以下步骤：步骤1，建立危化品运输机械臂末端执行器期望目标轨迹r
d
和期望回拢的关节角度θ
*
(0)，建立起危化品运输机械臂的运动学方程，通过D
‑
H参数法来描述相邻连杆之间的坐标方向和参数，危化品运输机械臂各关节及杆是刚性物体，对危化品运输机械臂各关节进行分析，建立全局坐标系与局部坐标系，全局坐标系是基于地面的坐标系，局部坐标系是根据D
‑
H参数建立的参考坐标系，通过局部坐标系中各关节角的齐次变换矩阵T
i
‑
1i
，得到危化品运输机械臂末端执行器在全局坐标系中的位置；步骤2，建立危化品运输机械臂末端执行器方向向量r(t)∈R
n
与关节角向量θ(t)∈R
m
之间的运动关系；步骤3，构建带约束条件的重复运动二次规划方案；步骤4，构建对偶神经网络求解模型。2.如权利要求1所述的基于对偶神经网络的危化品运输机械臂末端精确定位方法，其特征在于，所述步骤1中，齐次变换矩阵T
i
‑
1i
如下：其中θ
i
,α
i
,a
i
和d
i
分别代表机械臂第i关节的运动关节角，连杆转角，连杆长度和连杆偏距；计算出PA10机械臂各关节间的变换矩阵T
01
～T
67
，将这些变换矩阵相乘得到末端执行器相对于基坐标系的齐次变换矩阵，具体表示如下：其中，n∈R3是末端执行器在基坐标系中的法向量，s∈R3、a∈R3和p＝[p
x
,p
y
,p
z
]
T
分别是末端执行器的滑动向量、逼近向量和位置向量，那么PA10机械臂的末端执行器的位置向量r(t)∈R3与关节角向量θ(t)∈R7的关系如下式：r(t)＝f(θ(t))＝[p
x p
y p
z
]
T
ꢀꢀ
(3)对上述等式进行微分处理，从而计算出危化品运输机械臂的雅可比矩阵，如下：3.如权利要求2所述的基于对偶神经网络的危化品运输机械臂末端精确定位方法，其特征在于，所述步骤2中，运动关系表达式如下：g(θ(t))＝r(t)
ꢀꢀ
(5)其中：g(
·
):R
m
→
R
n
是一个非线性连续函数映射；所述步骤2的过程如下：2.1定义速度层优化性能指标为实现运动任务目标，通过最小化关节当前位置与初始位置之间的位移量来消除关节
角偏差，所得到的速度层优化性能指标描述如下：其中：θ(0)∈R
m
是关节角变量的初始值；β＞0是用来调节关节位移幅值的设计参数，由于等式(6)中a为决定变量，...

【专利技术属性】
技术研发人员：钱小鸿，孔颖，洪欣宇，周俊文，张铖涛，
申请(专利权)人：浙江科技学院，
类型：发明
国别省市：