基于已有路网的辅助定位方法与流程

文档序号:12662232阅读:来源:国知局

技术特征:

1.一种基于已有路网的辅助定位方法,其特征在于,包括以下步骤:

步骤一:提供一导航机器人,以及一用于所述导航机器人的待导航区域的路网地图;

所述路网地图中包括多条路径,所述导航机器人依照所述路径运行;

步骤二:将每一所述路径中包括起点、终点、拐点在内的多个位置标示为关键点,并标示每一所述关键点与周边障碍物之间的距离,记为标示数据;

步骤三:所述导航机器人实时测量与周边障碍物的距离,记为测量数据;

步骤四:确定所述导航机器人当前所处路径,将所述测量数据与对应的所述标示数据进行比对,校正运行路线:

所述导航机器人沿所述路径以直线运行时:

将其前后方向的所述测量数据与标示数据对比,确定所述导航机器人于所述路径中的位置;

将其左右方向的所述测量数据与所述标示数据对比,修正偏移;

所述导航机器人沿所述路径以曲线运行时:

其前后方向的所述测量数据动态变化;

将其左右方向的所述测量数据与所述标示数据对比,修正偏移;

步骤五:当所述测量数据与某一所述标示数据一致时,所述导航机器人选择执行转向动作或直行,并重新确定当前所处路径;

步骤六:重复所述步骤四和所述步骤五,直至到达目的地。

2.根据权利要求1所述的基于已有路网的辅助定位方法,其特征在于:所述导航机器人外侧竖直设有多个测距面,每一所述测距面均设有多个激光测距单元,实时测量与周边障碍物的距离。

3.根据权利要求2所述的基于已有路网的辅助定位方法,其特征在于:所述激光测距单元持续进行测距操作,每测得一定数量的距离数据便进行一次数据融合处理;

所述数据融合处理为:将多个所述距离数据中的最大值和最小值去掉,余下数据取平均值作为测距结果;

取多个所述激光测距单元测得的测距结果中的最小值作为所述测量数据。

4.根据权利要求2所述的基于已有路网的辅助定位方法,其特征在于:所述测距面设有三个激光测距单元,三个所述激光测距单元呈等腰三角形设置,所述等腰三角形的底角为5°,底边与水平面夹角为45°。

5.根据权利要求2所述的基于已有路网的辅助定位方法,其特征在于:每一所述标示数据分别包括前、后、左、右四个方向的距离数据;

所述导航机器人设有四个所述测距面,所述测量数据包括前、后、左、右四个方向的距离数据。

6.根据权利要求5所述的基于已有路网的辅助定位方法,其特征在于:根据运行方向的不同,每一所述关键点包括正向、反向两组所述标示数据。

当前第2页1 2 3 
网友询问留言 已有0条留言
  • 还没有人留言评论。精彩留言会获得点赞!
1