一种基于自适应前沿探索目标点选取的自主探索与避障方法技术

一种自适应前沿探索目标点选取的自主探索与避障方法，首先通过激光扫描仪扫描信息解释可通行区域选择的原理；其次通过基于自适应前沿探索目标点选取原理，选择适应当前时刻机器人位姿处的探索阈值，根据探索阈值及评价函数选择最优的探索目标点，考虑机器人在运动至探索目标点的过程中可能出现动态障碍物的情况，采用最小二乘法拟合动态障碍物的运动轨迹，判断机器人与障碍物的相对关系，再根据自适应前沿探索目标点选取原则，选择有效的探索目标点；最后，通过查询探索目标点的数据集，有效避免重复探索和漏探索的可能，确保探索的地图的完整性。本发明专利技术不仅可以满足实际应用的精度与实时性要求，而且成本较低。

【技术实现步骤摘要】
一种基于自适应前沿探索目标点选取的自主探索与避障方法
本专利技术应用于移动机器人同时定位和地图构建领域，涉及到移动机器人自主探索问题，尤其是场景中存在障碍物和狭窄过道的时候，如何选择可行的区域以及如何选择探索目标点的问题，实现了一种有效的自主探索方法。
技术介绍
本专利技术主要考虑移动机器人如何利用激光扫描仪有效地进行自主探索和场景地图构建的同时避免静态障碍物和动态障碍物。主要自主探索方法包括可行区域的判断方法、探索目标点的选取方法和动态障碍物避碰方法。虽然使用激光扫描仪构建场景地图已经非常成熟，但是让机器人自主的探索，并且构建场景地图的技术还尚未成熟，所以专利技术提出了一种不需要人为控制机器人运动，让机器人自主探索的一种场景地图构建方法。在进行自主探索级地图构建的同时由于场景中不可避免的存在障碍物，如果机器人能构建完整的场景地图，则势必要绕过一些障碍物，到达未知区域，才能获得未知区域的信息。基于激光传感器扫描的信息能够有效的识别当前环境信息，从而获得局部子目标和有效的行进路线，然而传统的自主探索方法根据前沿断点信息，机器人在遇到障碍物时，无法有效的绕过障碍物，以及忽略一些狭窄的通道和重复探索的问题，导致机器人构建的场景地图不完整和耗时量大等问题，并且当运动探索目标点的过程中出现动态障碍物的情况下，还容易发生碰撞。
技术实现思路
为解决机器人的自主探索与避障问题，本专利技术提供一种自适应前沿探索目标点选取方法，该方法根据场景中出现的静态障碍物，实时地选择合适的阈值，同时在动态障碍物出现时，采用最小二乘法对动态障碍物的位置进行预测，再利用自适应的前沿探索目标点选取方法避开障碍物且重新选择探索目标点。为了保证探索完整的场景地图，利用数据集记录场景中出现的所有探索目标点，并记录机器人在此探索目标点的运动方向，避免重复探索，同时，在机器人探索的过程中，实时的记录场景中的信息，构建一张储存场景信息的栅格地图，为了以后机器人在此地图上进行定位导航。此类方法数据储存量小，速度快，算法容易实现，且实施成本低等优点，能够满足移动机器人有效地避开障碍物且自主探索的应用需求。为了解决上述技术问题本专利技术提供如下的技术方案：一种基于自适应前沿探索目标点选取的自主探索与避障方法，所述方法包括以下步骤：1)判断可行区域，过程如下：长直过道为探索区域W，W中存在静态障碍物为简单多边形，其角点集合Gi＝{gi|i＝1，2，3，...，m)，移动机器人A可视为以O为圆心，r为半径的圆，激光扫描仪位置可视为质点o，以该质点o建立直角坐标系，机器人前进方向为X轴正半轴方向，机器人逆时针旋转的方向为Y轴正方向，任意时刻t，激光扫描仪的位置为Ot(0，0)，当选定的阈值为激光扫描仪的最大量程时，机器人的可视区域为dist(Ot，q)为激光扫描仪位置Ot与可视点q的欧式距离，定义关键角点：当前沿探索点的阈值设定为H时，根据前沿弧和激光射线围成的扇形区域为可视区域，可视区域S的边界与障碍物P相交的交点，将dist(Ot，gi)较小的角点gi定义为关键角点，计算安全距离Safedis＝dist(Ot，gi)*sin(α)，其中α为蓝色扇形区域所对应的圆心角的一半，当Safe_dis大于机器人半径r时，取扇形区域的角平分线方向作为目标方向，则将此扇形区域定为机器人的一个可行区域M；2)自适应前沿探索目标点选取，过程如下：在固定的激光扫描仪的最大量程无法寻找到可行区域的情况下，通过自适应的方式改变固定阈值，即根据障碍物出现的位置和机器人的最短距离为前沿探索目标点选取的阈值，根据自适应前沿探索目标点选取原理，以激光扫描仪中心点和最近障碍物D的角点g的距离值为探索的阈值，生成可视区域，此时机器人的运行方向从原来的角α方向变为角B方向，则在机器人运动的路径上，距离障碍物的最小距离值也由原来的d变为Safe_dis，此时的Safe_dis大于机器人的半径r，所以机器人可以安全的行驶至探索目标点处，从而避免机器人将某些狭窄的可行区域被忽略，该方法能够实时的扫描周围环境，及时判断周围障碍物的情况，从而实时的，自适应的改变前沿探索的阈值；3)动态障碍物预测和避障，过程如下：考虑就机器人在运行至探索目标点的过程中存在动态障碍物的情况，将每一次机器人向探索目标点运动的过程分为一段，每段的初始时刻机器人的位置为(0，0)，初始时刻，机器人连续n次采集激光扫描仪数据，根据下式计算障碍物位置信息(Xi，Yi)Xi＝dist(Ot，gi)*cosβ+xi(2)Yi＝dist(Ot，gi)*sinβ+yi其中，β为激光扫描仪与障碍物D的连线与X轴正方向的夹角，xi为i个扫描周期内机器人在X轴方向上移动的距离，yi为i个扫描周期内机器人在Y轴方向上移动的距离，xi和yi可以根据机器人的里程计信息获得，如果发现同一障碍物的位置发生变化，则根据最小二乘法原理将障碍物位置信息拟合成一条运动曲线，如下公式所示Y＝aX+b(3)其中根据式子(3)即可得知障碍物运动的轨迹随时间T的运动方程为：其中，t为i个激光扫描仪扫描周期的时间，每一次机器人向探索目标点运动，机器人的运动轨迹随时刻T的变化关系如下公式所示：xi＝0.2T(10)yi＝0(11)随着时间T的推移，计算激光扫描仪与障碍物的最短距离d，必然存在一个d的最小值：如果d＜机器人的半径r，则拟以机器人与障碍物距离最短时刻的障碍物点位置假设成一个静态障碍物点，继续采用步骤2)寻找探索目标点；4)评价函数的计算，过程如下：基于信息增益的计算方式，通过引入机器人路径代价和时效信息来计算信息增益：其中，A(p)为信息增益，σ为扇形可行区域的圆心角，H为选取可行区域时的阈值，θ为机器人从当前朝向转至该可行域的角平分线所需要的旋转角度，k1为具体实践时确定的参数。当F(H)越大，表示该可行区域中的目标点被探索价值越大；5)全局探索目标点记录与选择，过程如下：为了保证机器人可以探索到完整的地图，将探索目标点分为3类，记录在数据集中，第一类是机器人已经到达过的探索目标点，第二类是机器人已经遇到过但没有探索过的探索目标点，第三类是机器人在当前时刻下候选的探索目标点，当机器人运行至探索目标点时，发现当前位置下已经没有探索目标点时，机器人立刻搜索数据集，命令机器人运行至最近的没有探索过的探索目标点继续探索，直至将所有的探索目标点都走遍为止；6)开启gmapping节点通过采用机器人操作系统提供的gmapping构图程序，直接开启此节点即可记录激光扫描仪探索到的信息，并结合里程计信息实时的构建栅格形式场景地图。本专利技术的有益效果表现在：1、针对移动机器人运动模型建立了具体的可行区域的判断方法，该方法计算复杂度低，运算效率高。2、通过ROS这个次级系统并结合开源Gmapping算法，使得本专利技术的建图效果精确度高，而且简单方便，易于实现，成本较低。3、在大型场合，完全自主式的探索方式，不需要人为控制机器人运动，大大节省了人力，方便人类生活。附图说明图1是本专利技术方法可行域判断图，其中，10：机器人，11：Safe_dis，12:角点，13：障碍物D，14：关键角点g，15：激光射线m，16：激光射线n，17：角α，18：代表X轴正方向，19：代表Y轴正方向。图2是一种自适应前本文档来自技高网...

【技术保护点】
1.一种基于自适应前沿探索目标点选取的自主探索与避障方法，其特征在于，所述防复发包括以下步骤：1)判断可行区域，过程如下：长直过道为探索区域W，W中存在静态障碍物D，

【技术特征摘要】
1.一种基于自适应前沿探索目标点选取的自主探索与避障方法，其特征在于，所述防复发包括以下步骤：1)判断可行区域，过程如下：长直过道为探索区域W，W中存在静态障碍物D，为简单多边形，其角点集合Gi＝{gi|i＝1，2，3，...，m}，移动机器人A可视为以O为圆心，r为半径的圆，激光扫描仪位置可视为质点o，以该质点o建立直角坐标系，机器人前进方向为X轴正半轴方向，机器人逆时针旋转的方向为Y轴正方向，任意时刻t，激光扫描仪的位置为Ot(0，0)，当选定的阈值为激光扫描仪的最大量程时，机器人的可视区域为dist(Ot，q)为激光扫描仪位置Ot与可视点q的欧式距离，定义关键角点：当前沿探索点的阈值设定为H时，根据前沿弧和激光射线围成的扇形区域为可视区域，可视区域S的边界与障碍物P相交的交点，将dist(Ot，gi)较小的角点gi定义为关键角点，计算安全距离Safedis＝dist(Ot，gi)*sin(α)，其中α为蓝色扇形区域所对应的圆心角的一半，当Safe_dis大于机器人半径r时，取扇形区域的角平分线方向作为目标方向，则将此扇形区域定为机器人的一个可行区域M；2)自适应前沿探索目标点选取，过程如下：在固定的激光扫描仪的最大量程无法寻找到可行区域的情况下，通过自适应的方式改变固定阈值，即根据障碍物出现的位置和机器人的最短距离为前沿探索目标点选取的阈值，根据自适应前沿探索目标点选取原理，以激光扫描仪中心点和最近障碍物D的角点g的距离值为探索的阈值，生成可视区域，此时机器人的运行方向从原来的角α方向变为角B方向，则在机器人运动的路径上，距离障碍物的最小距离值也由原来的d变为Safe_dis，此时的Safe_dis大于机器人的半径r，所以机器人可以安全的行驶至探索目标点处，从而避免机器人将某些狭窄的可行区域被忽略，该方法能够实时的扫描周围环境，及时判断周围障碍物的情况，从而实时的，自适应的改变前沿探索的阈值；3)动态障碍物预测和避障，过程如下：考虑就机器人在运行至探索目标点的过程中存在动态障碍物的情况，将每一次机器人向探索目标点运动的过程分为一段，每段的初始时刻机器人的位置为(0，0)，初始时刻，机器...

【专利技术属性】
技术研发人员：邢科新，江超，林叶贵，
申请(专利权)人：浙江工业大学，
类型：发明
国别省市：浙江,33