一种移动机器人的路径规划方法技术

本发明专利技术公开一种移动机器人的路径规划方法，所述移动机器人的路径规划方法包括：首先初始化移动机器人的移动状态，构建弹性粒子模型，规划移动机器人在所述弹性粒子模型下的运动状态，计算移动机器人的实时累计能耗和复杂度。本发明专利技术考虑了移动机器人与障碍物之间的相互作用力，避免了远距离目标之间的相互作用，使移动机器人不必陷入局部平衡位置，主动性强，可以应用到任意目标位置。同时也有效地降低了移动机器人的能量损耗，有利于移动机器人路径规划的实现。利用弹性粒子模型有效地降低了路径规划实时计算的复杂度，同时缩短了移动路径，节省了移动机器人的能量损耗。

【技术实现步骤摘要】
一种移动机器人的路径规划方法
本专利技术属于机器人人工智能
，特别是涉及一种移动机器人的路径规划方法。
技术介绍
移动机器人广泛应用于各种领域，如路径检测、图像采集、障碍物检测、家庭服务等。在这些应用中，路径规划是移动机器人控制系统中最基本、最重要的组成部分，一直是移动机器人领域的研究热点。在许多物理场景中，移动机器人配备了计算和存储能力以及受限的电源。因此，路径规划的主要目标是从最小能量消耗的角度找到移动机器人从初始位置到目标位置的有效路径，保证移动机器人在障碍环境中的安全性。随着人工智能技术的不断发展，人们提出了许多方法，如人工势场法、神经网络算法、蚁群算法、遗传算法等智能路径规划。这些方法会存在一些问题。例如基于传统的人工势场法和蚁群算法都会使移动机器人比较容易的陷入局部最优位置，从而达不到真实的目标位置；基于传统的神经网络算法，需要冗余的计算资源，不能满足机器人对变化环境的处理要求。因此传统的移动机器人的路径规划算法存在计算复杂，易陷入局部最优等问题，导致最终结果精度下降。
技术实现思路
鉴于以上所述现有技术的缺点，本专利技术的目的在于提供一种移动机器人的路径规划方法，用于解决现有技术中计算复杂，移动过程中多余能量损耗的不足，有效提高了移动机器人的运动效率。为实现上述目的及其他相关目的，本专利技术提供一种移动机器人的路径规划方法，包括以下操作步骤：S1、初始化移动机器人的移动状态；S2、构建弹性粒子模型；S3、规划移动机器人在所述弹性粒子模型下的运动状态；S4、计算移动机器人的实时累计能耗和计算复杂度。作为本专利技术的一种优选方案，步骤S1具体包括以下操作步骤：初始化移动机器人的移动状态，所述移动机器人的移动状态包括移动机器人的初始速度、加速度、移动趋势、移动路径；移动趋势设置为移动机器人当前位置点指向目标点之间的连线，所述移动机器人当前位置点指向目标点之间的连线Lmt的直线方程为：Lmt:Ax+By+C＝0其中，A、B、C为直线方程的系数，均为实数；x为连线Lmt上的点在平面坐标系的横坐标，y为连线Lmt上的点在平面坐标系的纵坐标；移动机器人在当前位置可按照移动趋势移动的标准设置为：SM＜δ||ok-Lmt||为便于建模，将移动机器人和障碍物在平面坐标系的投影统一用圆形来表示，SM为该圆形的直径，移动机器人和障碍物的位置坐标，指的是该圆心的坐标。其中，SM表示移动机器人和障碍物标准形状的尺寸大小；ok表示移动机器人附近的第k个障碍物位置；||ok-Lmt||表示障碍物ok到所述移动机器人当前位置点指向目标点之间的连线Lmt的垂线距离；δ表示增益因子，且δ＞1；障碍物位置被标记的标准设置为：其中，xok表示障碍物ok在平面坐标系的横坐标，yok表示障碍物ok在平面坐标系的纵坐标；θ为设定的阈值。作为本专利技术的一种优选方案，步骤S2具体包括以下操作步骤：移动机器人在移动的路径中，被标记的障碍物位置集合表示为O：其中，ok表示第k个障碍物位置，第k个障碍物位置的横坐标为xok，第k个障碍物位置的纵坐标为yok；M表示障碍物的个数；移动机器人的位置集合表示为：其中，pi表示第i时刻移动机器人的位置，移动机器人的横坐标为xi，移动机器人的纵坐标为yi；N表示移动机器人采样位置点的个数；第k个障碍物的位置与第i时刻移动机器人的位置之间的距离表示为：移动机器人受到的虚拟弹性力为：F＝-k0(d-l)其中，F表示移动机器人受到当前障碍物的弹性力，k0表示虚拟弹簧的弹性常数，l表示虚拟弹簧的初始长度；移动机器人受到的虚拟弹性合力为：FR＝∑Fp+∑Fc+∑Ff移动机器人在一个采样周期内将受到三种弹性力，∑Fp表示移动机器人在移动过程中已路过的障碍物集群的弹性力，∑Fc表示移动机器人所在的当前障碍物集群的弹性力，∑Ff表示移动机器人在移动趋势下将要路过的障碍物集群的弹性力；其中，K1、K2、K3分别为对应障碍物集群内的障碍物个数；因此，移动机器人受到的虚拟弹性合力为：作为本专利技术的一种优选方案，步骤S3具体包括以下操作步骤：移动机器人在弹性粒子模型下的运动状态表示为：FR＝ma(t)其中，m表示移动机器人的质量，m为常数；t表示时间变量，为当前时刻；ΔT表示采样时间间隔，t+ΔT表示下一次采样时刻；a表示移动机器人的加速度；a(t)表示移动机器人的加速度是关于时间变量t的函数，代表当前时刻t的加速度；S表示移动机器人在弹性粒子模型下的累计移动的距离，S(t)表示移动机器人在弹性粒子模型下的累计移动的距离是关于时间变量t的函数，代表移动机器人在当前时刻t累计移动的距离；S(t+ΔT)表示到下一次采样时刻t+ΔT时，移动机器人累计移动的距离；V表示移动机器人在弹性粒子模型下的移动速度，V(t)表示移动机器人在弹性粒子模型下的移动速度是关于时间变量t的函数，代表移动机器人在当前时刻t的移动速度；V(t+ΔT)表示到下一次采样时刻t+ΔT时，移动机器人的移动速度；ξ表示积分变量，取值从积分下限值t一直取到积分上限值t+ΔT；运动状态的离散形式为：S(t+ΔT)＝S(t)+V(t)ΔTV(t+ΔT)＝V(t)+a(t)ΔT移动机器人在一个采样间隔内的运动可以表示为：移动机器人在初始时刻即t＝0运动状态为：S(t)＝0、V(t)＝0，在第一个采样间隔内运动状态可以表示为：一个采样周期结束的标准设置为：||oc-Lc||＝l其中，oc表示移动机器人在当前时刻要穿过的障碍物集群的中心位置，Lc表示移动机器人当前所在位置，l表示虚拟弹簧初始长度；Fip表示移动机器人在移动过程中，受到的已路过障碍物集群中第i个障碍物的弹性力；i的取值从1到K1，K1表示已路过障碍物集群中的障碍物数量；表示移动机器人在移动过程中，受到的当前所在障碍物集群中第j个障碍物的弹性力；j的取值从1到K2，K2表示当前所在障碍物集群中的障碍物数量；表示移动机器人在移动过程中，受到的后续将要路过障碍物集群中第k个障碍物的弹性力；k的取值从1到K3，K3表示后续将要路过障碍物集群中的障碍物数量；m表示移动机器人的质量，m为常数。作为本专利技术的一种优选方案，步骤S4具体包括以下操作步骤：移动机器人单位距离的平均能耗为Em，移动机器人的实时累计能耗为：每个障碍物的计算复杂度表示为o(1)，计算复杂度与障碍物的数量成比例，并假定其他因素忽略不计，总体计算复杂度为：o＝(K1+K2+K3)o(1)。如上所述，本专利技术的一种移动机器人的路径规划方法，具有以下有益效果：1、本专利技术考虑了移动机器人与障碍物之间的相互作用力，避免了远距离目标之间的相互作用，使移动机器人不必陷入局部平衡位置，主动性强，可以应用到任意目标位置。同时也有效地降低了移动机器人的能量损耗，有利于移动机器人路径规划的实现。2、利用弹性粒子模型有效地降低了路径规划实时计算的复杂度，同时缩短了移动路径，节省了移动机器人的能量损耗。附图说明图1显示为本专利技术的移动机器人的路径规划方法的流程示意图。图2显示为本专利技术的弹性粒子模型结构图。图3显示为本专利技术的移动机器人在任意采样周期内移动的轨迹图。图4显示为本专利技术的移动机器人在Matlab仿真下固定路径规划测试图。图5显示为本专利技术的移动机器人在Matlab仿真下任意路径规划测试图本文档来自技高网...

【技术保护点】
1.一种移动机器人的路径规划方法，其特征在于，包括以下操作步骤：S1、初始化移动机器人的移动状态；S2、构建弹性粒子模型；S3、规划移动机器人在所述弹性粒子模型下的运动状态；S4、计算移动机器人的实时累计能耗和计算复杂度。

【技术特征摘要】
1.一种移动机器人的路径规划方法，其特征在于，包括以下操作步骤：S1、初始化移动机器人的移动状态；S2、构建弹性粒子模型；S3、规划移动机器人在所述弹性粒子模型下的运动状态；S4、计算移动机器人的实时累计能耗和计算复杂度。2.如权利要求1所述的一种移动机器人的路径规划方法，其特征在于：步骤S1具体包括以下操作步骤：初始化移动机器人的移动状态，所述移动机器人的移动状态包括移动机器人的初始速度、加速度、移动趋势、移动路径；移动趋势设置为移动机器人当前位置点指向目标点之间的连线，所述移动机器人当前位置点指向目标点之间的连线Lmt的直线方程为：Lmt:Ax+By+C＝0其中，A、B、C为直线方程的系数，均为实数；x为连线Lmt上的点在平面坐标系的横坐标，y为连线Lmt上的点在平面坐标系的纵坐标；移动机器人在当前位置可按照移动趋势移动的标准设置为：SM＜δ||ok-Lmt||其中，SM表示移动机器人和障碍物标准形状的尺寸大小；ok表示移动机器人附近的第k个障碍物位置；||ok-Lmt||表示障碍物ok到所述移动机器人当前位置点指向目标点之间的连线Lmt的垂线距离；δ表示增益因子，且δ＞1；障碍物位置被标记的标准设置为：其中，xok表示障碍物ok在平面坐标系的横坐标，yok表示障碍物ok在平面坐标系的纵坐标；θ为设定的阈值。3.如权利要求2所述的一种移动机器人的路径规划方法，其特征在于：步骤S2具体包括以下操作步骤：移动机器人在移动的路径中，被标记的障碍物位置集合表示为O：O＝{o1,o2,L,ok-1,ok,L,oM}其中，ok表示第k个障碍物位置，第k个障碍物位置的横坐标为xok，第k个障碍物位置的纵坐标为yok；M表示障碍物的个数；移动机器人的位置集合表示为：P＝{p1,p2,L,pi-1,piL,pN}其中，pi表示第i时刻移动机器人的位置，移动机器人的横坐标为xi，移动机器人的纵坐标为yi；N表示移动机器人采样位置点的个数；第k个障碍物的位置与第i时刻移动机器人的位置之间的距离表示为：移动机器人受到的虚拟弹性力为：F＝-k0(d-l)其中，F表示移动机器人受到当前障碍物的弹性力，k0表示虚拟弹簧的弹性常数，l表示虚拟弹簧的初始长度；移动机器人受到的虚拟弹性合力为：FR＝∑Fp+∑Fc+∑Ff移动机器人在一个采样周期内将受到三种弹性力，∑Fp表示移动机器人在移动过程中已路过的障碍物集群的弹性力，∑Fc表示移动机器人所在的当前障碍物集群的弹性力，∑Ff表示移动机器人在移动趋势下将要路过的障碍物集群的弹性力；其中，kc＝k0，K1、K...

【专利技术属性】
技术研发人员：许钢，邢广鑫，江娟娟，俞晓峰，袁子琪，
申请(专利权)人：安徽工程大学，
类型：发明
国别省市：安徽,34