一种冗余型机械手自主自适应轨迹规划方法技术

本发明专利技术公开了一种冗余型机械手自主自适应轨迹规划方法，包括如下步骤：S101：建立冗余型机械手的运动学模型并获取结构参数和工作空间；根据冗余型机械手的结构参数和工作空间，对末端执行器进行路径规划；S102：依据冗余型机械手路径规划结果和任务需求，设置相应的伪吸引子和时间约束，建立冲击最优化轨迹问题的目标函数，选取若干轨迹点作为参数输入径向基神经网络，由径向基神经网络输出轨迹散点；S103：基于分段7次多项式插补算法拟合径向基神经网络输出的轨迹散点；S104：求解逆运动学方程获得关节空间轨迹；将轨迹参数导入基于VTK的可视化验证系统，验证轨迹的合理性。本发明专利技术可以实现冗余型机械手轨迹的快速优化，具有轨迹优化合理的优点。轨迹优化合理的优点。轨迹优化合理的优点。

【技术实现步骤摘要】
一种冗余型机械手自主自适应轨迹规划方法


[0001]本专利技术涉及机械手
，特别涉及一种冗余型机械手自主自适应轨迹规划方法。

技术介绍

[0002]冗余型机械手是可以进行自动化搬运作业的工业机器人。搬运作业是指用一种设备握持工件，从一个加工位置移到另一个加工位置。冗余型机械手可安装不同的末端执行器以完成各种不同形状和状态的工件搬运工作，大大减轻了人类繁重的体力劳动。冗余型机械手被广泛应用于机床上下料、冲压机自动化生产线、自动装配流水线、码垛搬运、集装箱等生产场景的自动搬运，它们有力地推动了汽车、电子、物流等传统制造业的快速发展。
[0003]目前轨迹规划主要根据已知特定任务进行特定的轨迹规划，但是当工厂里有多种不同作业任务则需要多次人为轨迹规划，且同一作业任务常常也存在零件公差带来的轨迹变化，这极大地影响了中小型企业柔性化加工作业的应用效率。如何适应当前柔性加工潮流下，实现自主自适应智能轨迹规划是当前轨迹规划现存问题之一。

技术实现思路

[0004]本专利技术的目的在于，提供一种冗余型机械手自主自适应轨迹规划方法。本专利技术有效的解决了轨迹自主自适应规划、轨迹规划结果验证等问题，保证冗余型机械手高速、低抖动地运行，更加适应行业柔性化、高生产节拍发展需求，满足高速运行状态下冗余型机械手轨迹的快速优化。
[0005]本专利技术的技术方案：一种冗余型机械手自主自适应轨迹规划方法，包括如下步骤：
[0006]S101：基于代数几何法建立冗余型机械手的运动学模型，根据运动学模型得到冗余型机械手的结构参数和工作空间；根据冗余型机械手的结构参数和工作空间，对末端执行器进行路径规划；
[0007]S102：依据冗余型机械手路径规划结果和任务需求，设置相应的伪吸引子和时间约束，建立冲击最优化轨迹问题的目标函数，选取若干轨迹点作为参数输入径向基神经网络，由径向基神经网络输出轨迹散点；
[0008]S103：基于分段7次多项式插补算法拟合径向基神经网络输出的轨迹散点；
[0009]S104：求解逆运动学方程获得关节空间轨迹；将轨迹参数导入基于VTK的可视化验证系统，验证轨迹的合理性。
[0010]上述的冗余型机械手自主自适应轨迹规划方法，所述结构参数和工作空间获取包括如下步骤：
[0011]S1011：根据冗余型机械手结构建立笛卡尔空间坐标系；
[0012]S1012：构建的冗余型机械手在坐标系中的正运动学模型，所述正运动学模型公式如下所示；
[0013]y＝
‑
l2sinr2‑
(d4‑
l3)sin(r2+r3)
‑
l5sin(r2+r3+r5)
[0014]z＝d0+d1+l
2 cosr2+(d4‑
l3)cos(r2+r3)+l
5 cos(r2+r3+r5)
[0015]r2+r3+r5+r6＝π
[0016]‑
l2sinr2+l3sin(r2+r3)＝0；
[0017]式中：y为末端执行器参考点y方向位移；l2为送进摆臂的长度，r2为送进摆臂与下滑板之间的夹角；d4为伸缩滑板和伸缩摆臂的总长度；l3为伸缩摆臂的长度；r3为伸缩滑板与送进摆臂延长线之间的夹角；l5为送料臂的长度；r5为送料臂与伸缩滑板延长线之间的夹角；z为末端执行器参考点z方向位移；d0为下滑板的初始位置；d1为下滑板相对于初始位置的位移；r6为末端执行器与坐标系Z方向的夹角；
[0018]S1013：针对正运动学模型公式进行逆运动学分析，得到冗余型机械手的结构参数和工作空间如下所示：
[0019]r2＝arcsin((y
‑
l5sin(π
‑
r6))/((d4‑
l3)l2/l3+l2))
[0020]r3＝π
‑
arcsin(l2sinr2/l3)
‑
r2[0021]r5＝π
‑
(r2+r3+r6)
[0022]d1＝z
‑
(l2cosr2+(d4‑
l3)cos(r2+r3)+l5cos(r2+r3+r6)+d0)。
[0023]前述的冗余型机械手自主自适应轨迹规划方法，所述末端执行器的路径规划是设置冗余型机械手在笛卡尔空间Z方向上一系列关键路径点Z＝[Z0，Z1，...，Z
n
‑1，Z
n
]，基于一系列预设的n+1个离散路径点，将整个工作路径划分为n段，当Z方向的轨迹规划完毕，即可确定Y方向的轨迹时间节点。
[0024]前述的冗余型机械手自主自适应轨迹规划方法，所述步骤S102的具体过程如下：
[0025]S1021、依据压力机的行程和工作环境中的障碍物，针对路径点设置相应的时间约束：
[0026]T
imin
≤T
i
≤T
imax
；
[0027]其中T
i
为第i个路径点的理想时间节点；
[0028]S1022、依据每个路径点的时间约束针对其设置相应的伪吸引子：
[0029]T
imin
≤t
i
≤T
imax
；
[0030]其中t
i
为第i个路径点设置的伪吸引子；
[0031]S1023、建立径向基神经网络冲击最优化轨迹问题的目标函数，目标函数采用如下公式：
[0032][0033]其中P
i
(t)为机械手运动周期内第i段轨迹的表达式；k为轨迹段的数量，M为第i个子轨迹中选择的时间节点数；
[0034]S1024、对生成的初始轨迹进行优化，以Z方向设置评估函数系统总能量，评估函数的公式如下：
[0035]E2(t)＝min(|Z(t)
(3)
|
max
)；
[0036]其中|Z(t)
(3)
|
max
为在机械手运动周期内末端执行器Z方向轨迹的最大加加速度值；
[0037]S1025、选取若干轨迹点作为数据集输入径向基神经网络，然后基于半监督学习策
略寻找满足约束的最优时间节点。
[0038]前述的冗余型机械手自主自适应轨迹规划方法，所述步骤S103的具体过程如下：
[0039]S1031、通过将轨迹散点划分为n段子轨迹，其中第i个子轨迹的多项式插值函数P
i
表示为：
[0040][0041]其中t∈[t
i
‑1，t
i
]，是第i个子轨迹的多项式参数，i的取值范围为1到n；
[0042]第i条子轨迹的速度V、加速度A和加加速度J分别表示为：
[0043][0044][0045][0046]令S(t)为位移对时间的4阶导数，其公式表示为：
[0047]本文档来自技高网...

【技术保护点】

【技术特征摘要】
1.一种冗余型机械手自主自适应轨迹规划方法，其特征在于：包括如下步骤：S101：基于代数几何法建立冗余型机械手的运动学模型，根据运动学模型得到冗余型机械手的结构参数和工作空间；根据冗余型机械手的结构参数和工作空间，对末端执行器进行路径规划；S102：依据冗余型机械手路径规划结果和任务需求，设置相应的伪吸引子和时间约束，建立冲击最优化轨迹问题的目标函数，选取若干轨迹点作为参数输入径向基神经网络，由径向基神经网络输出轨迹散点；S103：基于分段7次多项式插补算法拟合径向基神经网络输出的轨迹散点；S104：求解逆运动学方程获得关节空间轨迹；将轨迹参数导入基于VTK的可视化验证系统，验证轨迹的合理性。2.根据权利要求1所述的冗余型机械手自主自适应轨迹规划方法，其特征在于：所述结构参数和工作空间获取包括如下步骤：S1011：根据冗余型机械手结构建立笛卡尔空间坐标系；S1012：构建的冗余型机械手在坐标系中的正运动学模型，所述正运动学模型公式如下所示；y＝
‑
l2sinr2‑
(d4‑
l3)sin(r2+r3)
‑
l5sin(r2+r3+r5)z＝d0+d1+l2cosr2+(d4‑
l3)cos(r2+r3)+l5cos(r2+r3+r5)r2+r3+r5+r6＝π
‑
l2sinr2+l3sin(r2+r3)＝0；式中：y为末端执行器参考点y方向位移；l2为送进摆臂的长度，r2为送进摆臂与下滑板之间的夹角；d4为伸缩滑板和伸缩摆臂的总长度；l3为伸缩摆臂的长度；r3为伸缩滑板与送进摆臂延长线之间的夹角；l5为送料臂的长度；r5为送料臂与伸缩滑板延长线之间的夹角；z为末端执行器参考点z方向位移；d0为下滑板的初始位置；d1为下滑板相对于初始位置的位移；r6为末端执行器与坐标系Z方向的夹角；S1013：针对正运动学模型公式进行逆运动学分析，得到冗余型机械手的结构参数和工作空间如下所示：r2＝arcsin((y
‑
l5sin(π
‑
r6))/((d4‑
l3)l2/l3+l2))r3＝π
‑
arcsin(l2sinr2/l3)
‑
r2r5＝π
‑
(r2+r3+r6)d1＝z
‑
(l2cosr2+(d4‑
l3)cos(r2+r3)+l5cos(r2+r3+r6)+d0)。3.根据权利要求2所述的冗余型机械手自主自适应轨迹规划方法，其特征在于：所述末端执行器的路径规划是设置冗余型机械手在笛卡尔空间Z方向上一系列关键路径点Z＝[Z0，Z1，...，Z
n
‑1，Z
n
]，基于一系列预设的n+1个离散路径点，将整个工作路径划分为n段，当Z方向的轨迹规划完毕，即可确定Y方向的轨迹时间节点。4.根据权利要求3所述的冗余型机械手自主自适应轨迹规划方法，其特征在于：所述步骤S102的具体过程如下：S1021：依据压力机的行程和工作环境中的障碍物，针对路径点设置相应的时间约束：T
imin
≤T
i
≤T
imax
；其中T
i
为第i个路径点的理想时间节点；
S1022：依据每个路径点的时间约束针对其设置相应的伪吸引子：T
imin
≤t
i
≤T
imax
；其中t
i
为第i个路径点设置的伪吸引子；S1023：建立径向基神经网络冲击最优化轨迹问题的目标函数，目...

【专利技术属性】
技术研发人员：周顺情，黄沈权，马晴晴，于鲁川，沈谞言，蔡梦澳，
申请(专利权)人：温州大学，
类型：发明
国别省市：