一种机械臂动态避障轨迹规划方法

摘要: 本发明涉及机械臂运动规划的,尤其涉及一种机械臂动态避障轨迹规划方法。背景技术:1、现有机械臂动态避障轨迹规划技术常采用随机树结合人工势场的融合规划方案,被广泛应...
一种机械臂动态避障轨迹规划方法

本发明涉及机械臂运动规划的,尤其涉及一种机械臂动态避障轨迹规划方法。

背景技术:

1、现有机械臂动态避障轨迹规划技术常采用随机树结合人工势场的融合规划方案,被广泛应用于人机协作、智能制造等动态交互作业场景。其中,快速扩展随机树(rapidly-exploring random tree,rrt)因采样随机性强,导致无效采样多、路径冗余度高;引入高斯混合模型(gaussian mixture model,gmm)引导采样时,其参数依赖期望最大化(expectation-maximization,em)算法估计,易陷入局部最优,且环境自适应能力弱,难以在障碍物布局变化时持续生成优质全局基础路径。

2、同时,传统人工势场法(artificial potential field,apf)仅依据障碍物距离构建斥力场,未考虑动态障碍物的速度特征,难以预判动态障碍物的碰撞风险;引力场采用单一线性或二次型作用方式,易出现近距离引力不足、远距离引力突变的问题,难以适配机械臂从起点到目标点的平稳避障需求。此外,多数方法将全局路径规划与局部动态避障作为独立模块串行处理,缺乏信息反馈与协同修正机制,轨迹平滑校验缺乏分级安全约束,导致复杂动态场景下避障安全性与轨迹平顺性难以兼顾。

3、因此,亟需一种能够解决上述诸多问题的机械臂动态避障轨迹规划方法,实现机械臂在动态复杂环境下的高效、安全轨迹规划。

技术实现思路

1、本发明的目的在于提供一种机械臂动态避障轨迹规划方法,解决了现有机械臂轨迹规划采样低效、参数适配性差、缺乏速度感知及全局与局部规划割裂的技术问题。

2、为解决上述技术问题,本发明技术方案如下:

3、本发明提供了一种机械臂动态避障轨迹规划方法,所述方法采用全局预测与局部反应分层联动架构,依次包括以下步骤:s1.构建机械臂三维工作空间环境模型,获取空间内静态障碍物、动态障碍物的位置及运动参数,确定运动起点与目标点;s2.建立表征所述工作空间采样概率分布的高斯混合模型,所述高斯混合模型的参数包括权重、均值、协方差矩阵,采用遗传算法对所述高斯混合模型的参数进行全局迭代优化,以优化后的高斯混合模型引导快速扩展随机树的采样方向,生成全局基础路径;s3.以所述全局基础路径为参考轨迹,构建包含引力场与斥力场的改进人工势场,所述引力场基于所述机械臂与所述目标点之间的距离分段构造,所述斥力场中引入与障碍物速度负相关的调节因子,根据所述引力场和所述斥力场的合力实时修正机械臂的运动轨迹;s4.对修正后的运动轨迹进行插值平滑处理,校验平滑处理后的轨迹点与障碍物的间距,将间距小于第一预设阈值的轨迹点替换为满足安全约束的替代点,输出机械臂执行轨迹。

4、进一步的,所述采用遗传算法对高斯混合模型的参数进行全局迭代优化,包括以下步骤:将高斯混合模型的权重、均值和协方差矩阵编码为遗传算法的个体;构建兼顾目标导向、空间探索、障碍物规避和路径可行的多目标适应度函数;通过选择、交叉和变异操作对种群进行迭代优化,输出适应度最高的个体所对应的高斯混合模型参数。

5、进一步的,所述以优化后的高斯混合模型引导快速扩展随机树的采样方向,包括以下步骤:预设目标偏向采样概率,以所述目标偏向采样概率直接采样目标点;剩余采样概率根据所述优化后的高斯混合模型的概率分布生成采样点。

6、进一步的,所述目标点对所述机械臂施加引力;所述静态障碍物对所述机械臂产生第一斥力;所述动态障碍物对所述机械臂产生与速度关联的第二斥力;所述引力、所述第一斥力与所述第二斥力矢量叠加形成所述合力。

7、进一步的,当障碍物向机械臂靠近时启用所述第二斥力,且所述第二斥力的斥力增益系数大于所述第一斥力的斥力增益系数。

8、进一步的,所述斥力场中引入与障碍物速度负相关的调节因子,具体为:在排斥势能函数中设置与所述障碍物速度负相关的指数衰减因子;障碍物速度越大则所述指数衰减因子越小,对应的排斥势能峰值越高。

9、进一步的,所述引力场设有第二预设阈值;当所述机械臂与所述目标点的距离小于第二预设阈值时,引力呈二次型增长;当所述机械臂与所述目标点的距离大于等于第二预设阈值时,引力呈线性增长。

10、进一步的,所述插值平滑处理采用catmull-rom样条算法生成平滑轨迹。

11、进一步的,当轨迹点与障碍物间距小于所述第一预设阈值时,判定所述轨迹点为不安全轨迹点;以所述不安全轨迹点为中心划定球形邻域,在球形邻域内重采样筛选满足安全约束的轨迹点替换所述不安全轨迹点。

12、进一步的,所述第一预设阈值分为动态障碍物预设安全阈值和静态障碍物预设安全阈值,所述动态障碍物预设安全阈值大于所述静态障碍物预设安全阈值。

13、与现有技术相比,本发明至少包括以下有益效果:

14、本发明通过遗传算法全局优化高斯混合模型参数引导快速扩展随机树采样,无需人工反复调试模型参数,缩小快速扩展随机树无效采样范围,降低路径冗余节点,提升了全局基础路径的生成效率与路径最优性。

15、本发明构建带速度调节因子的差异化斥力场与分段引力场,可依据动态障碍物运动强度调整斥力大小,区分动静障碍物斥力增益,引力分段输出平稳作用力,能够对动态障碍物实现更早、更合理的避让,规避碰撞风险。

16、本发明采用全局预测-局部反应分层联动架构,以全局基础路径作为势场实时修正基准,搭配带分级安全阈值的catmull-rom平滑重采样机制,兼顾全局路径最优与局部动态避障,保障输出轨迹全程满足安全约束、运动平滑连续。

1.一种机械臂动态避障轨迹规划方法,其特征在于,所述方法采用全局预测与局部反应分层联动架构,依次包括以下步骤:

2.根据权利要求1所述的机械臂动态避障轨迹规划方法,其特征在于,所述采用遗传算法对高斯混合模型的参数进行全局迭代优化,包括以下步骤:

3.根据权利要求1所述的机械臂动态避障轨迹规划方法,其特征在于,所述以优化后的高斯混合模型引导快速扩展随机树的采样方向,包括以下步骤:

4.根据权利要求1所述的机械臂动态避障轨迹规划方法,其特征在于,

5.根据权利要求4所述的机械臂动态避障轨迹规划方法,其特征在于,当障碍物向机械臂靠近时启用所述第二斥力,且所述第二斥力的斥力增益系数大于所述第一斥力的斥力增益系数。

6.根据权利要求1所述的机械臂动态避障轨迹规划方法,其特征在于,所述斥力场中引入与障碍物速度负相关的调节因子,具体为:

7.根据权利要求1所述的机械臂动态避障轨迹规划方法,其特征在于,

8.根据权利要求1所述的机械臂动态避障轨迹规划方法,其特征在于,所述插值平滑处理采用catmull-rom样条算法生成平滑轨迹。

9.根据权利要求8所述的机械臂动态避障轨迹规划方法,其特征在于,

10.根据权利要求9所述的机械臂动态避障轨迹规划方法,其特征在于,所述第一预设阈值分为动态障碍物预设安全阈值和静态障碍物预设安全阈值,所述动态障碍物预设安全阈值大于所述静态障碍物预设安全阈值。