一种具有抗噪特性的轮式移动机械臂重复运动规划方法技术

本发明专利技术涉及一种具有抗噪特性的轮式移动机械臂重复运动规划方法，包括以下步骤：步骤1：根据负梯度下降公式推导在速度层上描述的性能指标；步骤2：基于误差反馈设计具有抗噪特性的新型运动学方程；步骤3：结合性能指标和运动学方程建立速度层重复运动规划方案；步骤4：将速度层重复运动规划方案转化为二次优化问题；步骤5：采用递归神经网络求解二次优化问题；步骤6：轮式移动机械臂的控制器根据求解结果实时驱动移动平台的双轮和机械臂的关节完成给定的轨迹规划任务，并在任务完成后控制移动平台和机械臂同时回到初始状态。与现有技术相比，本发明专利技术具有使得轮式移动机械臂在存在噪声干扰的情况下仍能有效地实现重复运动规划的目的等优点。的目的等优点。的目的等优点。

【技术实现步骤摘要】
一种具有抗噪特性的轮式移动机械臂重复运动规划方法


[0001]本专利技术涉及移动机械臂的运动规划及控制领域，尤其是涉及一种具有抗噪特性的轮式移动机械臂重复运动规划方法。

技术介绍

[0002]轮式移动机械臂(由双轮驱动的移动平台和n自由度的机械臂组成)因其可移动性和可操作性而具有非常大且灵活的工作空间，已广泛应用于物流、汽车、食品和医药等诸多行业，在这些应用中，轮式移动机械臂运动规划的重复性是用来评估给定任务执行效果的一个重要指标。
[0003]如何有效实现轮式移动机械臂的重复运动规划是研究热点之一，目前已有多种重复运动规划方案被提出，其中包括基于伪逆和二次规划描述的方案；它们可使得移动平台和机械臂在任务完成后同时回到各自的初始状态。
[0004]然而，这些方案都是在不考虑噪声干扰情况下进行研究和设计的，因而本质上缺乏抗噪能力，如果遇到外界环境噪声的干扰，那么这些方案将会失效，从而无法使得轮式移动机械臂完成给定的轨迹规划任务，页无法实现重复运动规划的目标。

技术实现思路

[0005]本专利技术的目的就是为了克服上述现有技术存在的缺陷而提供一种具有抗噪特性的轮式移动机械臂重复运动规划方法。
[0006]本专利技术的目的可以通过以下技术方案来实现：
[0007]一种具有抗噪特性的轮式移动机械臂重复运动规划方法，该方法包括以下步骤：
[0008]步骤1：根据负梯度下降公式推导轮式移动机械臂在速度层上描述的性能指标；
[0009]步骤2：基于误差反馈设计具有抗噪特性的新型运动学方程；
[0010]步骤3：结合性能指标和新型运动学方程建立速度层重复运动规划方案；
[0011]步骤4：将速度层重复运动规划方案转化为二次优化问题；
[0012]步骤5：采用递归神经网络求解二次优化问题；
[0013]步骤6：轮式移动机械臂的控制器根据求结果实时完成轨迹规划任务，并在任务完成后复位。
[0014]所述的步骤1中，推导轮式移动机械臂在速度层上描述的性能指标的过程具体为：
[0015]基于轮式移动机械臂当前状态与初始状态之间偏差的最小化思想，根据负梯度下降公式推导在速度层上描述的性能指标，所述的轮式移动机械臂包括双轮驱动的移动平台和安装固定在移动平台上且具有n自由度的机械臂，所述的性能指标的表达式为：
[0016][0017]其中，Ψ为性能指标，||
·
||2表示向量的二范数，表示轮式移动机械臂的增广位置向量，n为自由度个数，p
x
∈R和p
y
∈R分别表示移动平台在水
平地面上沿着X轴和Y轴方向的位置，即机械臂的底座安装固定在移动平台上的位置，φ∈R表示移动平台的朝向角，θ∈R
n
表示机械臂的关节角度，表示轮式移动机械臂的增广速度向量，和分别表示p
x
、p
y
和φ的时间导数，表示机械臂的关节速度，v＝[p
x
‑
p
x0
；p
y
‑
p
y0
；cos(φ)(sin(φ)
‑
sin(φ0))；θ
‑
θ0],v∈R
3+n
为偏差向量，p
x0
∈R、p
y0
∈R和φ0∈R分别表示移动平台在X轴的初始位置、Y轴方向的初始位置以及初始朝向角，θ0∈R
n
表示机械臂关节角度的初始值，p
x0
、p
y0
、φ0和θ0组成联合向量表示轮式移动机械臂的初始状态，即轮式移动机械臂执行轨迹规划任务时的起始状态，λ＞0∈R为设计参数，用以调节性能指标，使得轮式移动机械臂实现重复运动规划的目标。
[0018]所述的步骤2中，设计具有抗噪特性的新型运动学方程的过程具体为：
[0019]根据轮式移动机械臂的速度层运动学方程，引入末端执行器规划误差及其积分信息的反馈，获取具有抗噪特性的新型运动学方程，具有抗噪特性的新型运动学方程的表达式为：
[0020][0021]其中，J∈R
m
×
(3+n)
表示轮式移动机械臂的雅克比矩阵，f(
·
):R
3+n
→
R
m
表示非线性映射函数，r∈R
m
表示机械臂末端执行器在m维空间中的位置向量，表示r的时间导数，α＞0∈R和β＞0∈R均表示反馈系数，且两者的关系满足α2＞β，t＞0∈R表示时间，表示机械臂末端执行器的规划误差，τ∈R表示积分变量，δ∈R
m
表示轮式移动机械臂在运动规划过程中可能存在的噪声向量。
[0022]所述的步骤3中，所述的速度层重复运动规划方案具体为：
[0023]最小化性能指标
[0024]受到新型运动学方程、移动平台双驱动轮的旋转角度极限和旋转角速度极限、机械臂关节的角度极限和速度极限的约束，新型运动学方程对应于轮式移动机械臂在速度层上的轨迹规划任务；
[0025]所述的新型运动学方程、移动平台双驱动轮的旋转角度极限和旋转角速度极限、机械臂关节的角度极限和速度极限的表达式分别为：
[0026][0027]ω
‑
≤ω≤ω
+
[0028][0029]θ
‑
≤θ≤θ
+
[0030][0031]其中，ω∈R2和分别表示移动平台两个驱动轮的旋转角度和旋转角速度，ω
±
、θ
±
和分别表示驱动轮旋转角度ω、驱动轮旋转角速度机械臂关节角度θ和机械臂关节速度的上下极限。
[0032]所述的步骤4中，将速度层重复运动规划方案转化的二次优化问题具体为：
[0033]最小化x
T
Qx/2+p
T
x；
[0034]受约束于两个约束条件，分别为第一约束条件和第二约束条件，第一约束条件和第二约束条件的表达式分别为：
[0035]Ax＝b
[0036]ξ
‑
≤x≤ξ
+
[0037]其中，表示二次优化问题的决策变量，u＝[ω；θ],u∈R
2+n
和分别为轮式移动机械臂的联合角度向量和联合速度向量，Q＝W
T
W,Q∈R
(2+n)
×
(2+n)
表示系数矩阵，T表示转置，W＝[M,0；0,I],W∈R
(3+n)
×
(2+n)
表示增广矩阵，M＝[γcos(φ)/2,γcos(φ)/2；γsin(φ)/2,γsin(φ)/2；
‑
γ/d,γ/d],M∈R3×2表示由移动平台自身结构参数所组成的矩阵，γ＞0∈R表示移动平台驱动轮的半径，d＞0∈R表示移动平台两个驱动轮中心点的距离，I∈R
n...

【技术保护点】

【技术特征摘要】
1.一种具有抗噪特性的轮式移动机械臂重复运动规划方法，其特征在于，该方法包括以下步骤：步骤1：根据负梯度下降公式推导轮式移动机械臂在速度层上描述的性能指标；步骤2：基于误差反馈设计具有抗噪特性的新型运动学方程；步骤3：结合性能指标和新型运动学方程建立速度层重复运动规划方案；步骤4：将速度层重复运动规划方案转化为二次优化问题；步骤5：采用递归神经网络求解二次优化问题；步骤6：轮式移动机械臂的控制器根据求结果实时完成轨迹规划任务，并在任务完成后复位。2.根据权利要求1所述的一种具有抗噪特性的轮式移动机械臂重复运动规划方法，其特征在于，所述的步骤1中，推导轮式移动机械臂在速度层上描述的性能指标的过程具体为：基于轮式移动机械臂当前状态与初始状态之间偏差的最小化思想，根据负梯度下降公式推导在速度层上描述的性能指标，所述的轮式移动机械臂包括双轮驱动的移动平台和安装固定在移动平台上且具有n自由度的机械臂，所述的性能指标的表达式为：其中，Ψ为性能指标，||
·
||2表示向量的二范数，表示轮式移动机械臂的增广位置向量，n为自由度个数，p
x
∈R和p
y
∈R分别表示移动平台在水平地面上沿着X轴和Y轴方向的位置，即机械臂的底座安装固定在移动平台上的位置，φ∈R表示移动平台的朝向角，θ∈R
n
表示机械臂的关节角度，表示轮式移动机械臂的增广速度向量，和分别表示p
x
、p
y
和φ的时间导数，表示机械臂的关节速度，v＝[p
x
‑
p
x0
；p
y
‑
p
y0
；cos(φ)(sin(φ)
‑
sin(φ0))；θ
‑
θ0],v∈R
3+n
为偏差向量，p
x0
∈R、p
y0
∈R和φ0∈R分别表示移动平台在X轴的初始位置、Y轴方向的初始位置以及初始朝向角，θ0∈R
n
表示机械臂关节角度的初始值，p
x0
、p
y0
、φ0和θ0组成联合向量表示轮式移动机械臂的初始状态，即轮式移动机械臂执行轨迹规划任务时的起始状态，λ＞0∈R为设计参数，用以调节性能指标，使得轮式移动机械臂实现重复运动规划的目标。3.根据权利要求2所述的一种具有抗噪特性的轮式移动机械臂重复运动规划方法，其特征在于，所述的步骤2中，设计具有抗噪特性的新型运动学方程的过程具体为：根据轮式移动机械臂的速度层运动学方程，引入末端执行器规划误差及其积分信息的反馈，获取具有抗噪特性的新型运动学方程，具有抗噪特性的新型运动学方程的表达式为：其中，J∈R
m
×
(3+n)
表示轮式移动机械臂的雅克比矩阵，f(
·
):R
3+n
→
R
m
表示非线性映射函数，r∈R
m
表示机械臂末端执行器在m维空间中的位置向量，表示r的时间导数，α＞0∈R和β＞0∈R均表示反馈系数，且两者的关系满足α2＞β，t＞0∈R表示时间，
表示机械臂末端执行器的规划误差，τ∈R表示积分变量，δ∈R
m
表示轮式移动机械臂在运动规划过程中可能存在的噪声向量。4.根据权利要求3所述的一种具有抗噪特性的轮式移动机械臂重复运动规划方法，其特征在于，所述的步骤3中，所述的速度层重复运动规划方案具体为：最小化性能指标受到新型运动学方程、移动平台双驱动轮的旋转角度极限和旋转角速度极限、机械臂关节的角度极限和速度极限的约束，新型运动学方程对应于轮式移动机械臂在速度层上的轨迹规划任务；所述的新型运动学方程、移动平台双驱动轮的旋转角度极限和旋转角速度极限、机械臂关节的角度极限和速度极限的表达式分别为：ω

【专利技术属性】
技术研发人员：郭东生，张卫东，柏林，张彦群，朱晓光，潘阳，王涛，
申请(专利权)人：海南大学，
类型：发明
国别省市：