一种动态窗口局部路径规划方法

    技术2025-05-29  41


    本发明涉及移动机器人路径规划领域,更具体地,涉及一种动态窗口局部路径规划方法。


    背景技术:

    1、移动机器人局部路径规划通过多类型传感器动态感知周围环境、构建周边环境地图,并采用相关算法规划出无碰撞风险的最优路径,从而使机器人具备良好的实时避障能力。这一技术在自动驾驶汽车、无人机、服务机器人等领域具有重要意义。常用的局部路径规划方法包括动态窗口法、人工势场法、时间弹性带方法等。其中动态窗口法因为考虑机器人动力学约束和实时性,而被广泛采用。

    2、动态窗口法(dynamic window approach,dwa)是fox d等人提出的局部路径规划方法。该方法从速度空间(v,ω)中采样线速度v和角速度ω的组合,模拟出多组可达轨迹,设计合理的评价函数,实现局部路径规划寻优。

    3、现有dwa评价函数主要针对地面动/静障碍物而设计,对于高速落体、空中抛物等空中障碍物,在其接触地面之前,没有被纳入评价函数考虑的范围中,因此难以对其实现有效的避障规划。为此,在dwa中常采用缩减预测时间窗口应对突发障碍物,然而由于预测时间窗口的减少,可能导致模拟可达轨迹信息不充分,无法准确评估潜在威胁,影响避障决策的准确性。


    技术实现思路

    1、为了解决现有动态窗口法(dwa)的局限性,提供一种动态窗口局部路径规划方法,包括:

    2、步骤s1,采集机器人状态信息、地面环境信息和空中障碍物信息;

    3、步骤s2,根据所述机器人状态信息,基于运动学模型计算机器人未来预测轨迹;根据空中障碍物信息,拟合空中障碍物的预测轨迹点序列;根据机器人未来预测轨迹和空中障碍物的预测轨迹点序列,对空中障碍物与机器人进行碰撞预测,输出预测碰撞坐标和预测碰撞时间th;

    4、步骤s3,以空中障碍物的预计碰撞时间th为时间窗口,计算所有安全实现的结果速度空间vr,所述结果速度空间vr由机器人线速度v和角速度ω的集合(v,ω)组成;

    5、步骤s4,从结果速度空间vr中离散采样机器人的线速度v和角速度ω的组合,模拟出多条可达轨迹;

    6、步骤s5,基于多目标评价函数计算每一条可达轨迹的评价值;

    7、步骤s6,从多条可达轨迹中选择评价值最高的可达轨迹,获取评价值最高的可达轨迹对应的机器人的线速度和角速度组合(vbest,ωbest),完成局部避障轨迹规划。

    8、本发明提供的一种动态窗口局部路径规划方法,在规划机器人的路径时,对突发空中障碍物及地面障碍物的避障需求,规划出安全可行的轨迹,提升机器人在多变环境下的避障效率与安全性。



    技术特征:

    1.一种动态窗口局部路径规划方法,其特征在于,包括:

    2.根据权利要求1所述的动态窗口局部路径规划方法,其特征在于,所述步骤s1采集的机器人状态信息表示为:

    3.根据权利要求2所述的动态窗口局部路径规划方法,其特征在于,所述步骤s2,根据所述机器人状态信息,基于运动学模型计算机器人未来预测轨迹,包括:

    4.根据权利要求2所述的动态窗口局部路径规划方法,其特征在于,所述步骤s2,根据空中障碍物信息,拟合空中障碍物的预测轨迹点序列,包括:

    5.根据权利要求1所述的动态窗口局部路径规划方法,其特征在于,所述步骤s2中,根据机器人未来预测轨迹和空中障碍物的预测轨迹点序列,对空中障碍物与机器人进行碰撞预测,输出预测碰撞坐标和预测碰撞时间th,包括:

    6.根据权利要求2所述的动态窗口局部路径规划方法,其特征在于,所述步骤s3,以空中障碍物的预计碰撞时间th为时间窗口,计算所有安全实现的结果速度空间vr,包括:

    7.根据权利要求2所述的动态窗口局部路径规划方法,其特征在于,所述多目标评价函数的表达式如下:

    8.根据权利要求7所述的动态窗口局部路径规划方法,其特征在于,基于模糊规则的自适应权重策略,根据场景自适应调整λ1,λ2权重大小,包括:


    技术总结
    本发明提供一种动态窗口局部路径规划方法,包括:基于运动学模型计算机器人未来预测轨迹;根据空中障碍物信息拟合空中障碍物的预测轨迹点序列;对空中障碍物与机器人进行碰撞预测,输出预测碰撞坐标和预测碰撞时间t<subgt;h</subgt;;以空中障碍物的预计碰撞时间t<subgt;h</subgt;为时间窗口,计算所有安全实现的结果速度空间V<subgt;r</subgt;;从结果速度空间V<subgt;r</subgt;中离散采样机器人的线速度v和角速度ω的组合,模拟出多条可达轨迹;基于多目标评价函数计算每一条可达轨迹的评价值;从多条可达轨迹中选择评价值最高的可达轨迹,完成局部避障轨迹规划。本发明在规划机器人的路径时,对突发空中障碍物及地面障碍物的避障需求,规划出安全可行的轨迹,提升机器人在多变环境下的避障效率与安全性。

    技术研发人员:宋宝,李成池,尹家阳,周向东,张宏超,刘永兴,钟靖龙,刘洋,唐小琦
    受保护的技术使用者:华中科技大学
    技术研发日:
    技术公布日:2024/10/24
    转载请注明原文地址:https://symbian.8miu.com/read-31497.html

    最新回复(0)