[发明专利]移动导航方法和系统

摘要

一种移动导航系统，包括：传感器，用于采集环境数据；计算处理单元，用于根据所述传感器所采集的数据，对所述数据进行计算，以构建三维地图；并根据所构建的三维地图，提供由起始点至目的点之间的路径规划；驱动机构，用于根据所述计算处理单元所提供的所述路径，驱动所述移动导航系统移动。本发明还提供一种利用该移动导航系统进行地图构建的方法和路径规划的方法。

主权项

1.一种移动导航系统，其特征在于，所述移动导航系统包括：传感器，用于采集环境数据；计算处理单元，用于根据所述传感器所采集的数据，对所述数据进行计算，以构建三维地图；并根据所构建的三维地图，提供由起始点至目的点之间的路径规划；驱动机构，用于根据所述计算处理单元所提供的所述路径，驱动所述移动导航系统移动；所述移动导航系统进一步包括：数据点滤波器，用于把所述传感器所采集生成的点集作为输入，并处理后输出另一点集；kd树匹配器，用于利用kd树数据结构在点集X中寻找离点集P最近的对应数据点；外层滤波器，用于检测kd树匹配器所建立的数据点的对应联系，并去除新采集点集P中预定的点和点集X中对应点的联系；误差缩小器，用于根据点到点或者点到平面的距离法则求出点集Pk到点集Yk的误差e；条件检测器，用于根据预设的终止条件而检测迭代是否满足该预设的终止条件，并在满足该预设的终止条件时终止迭代；所述移动导航系统进一步包括：地图绘制模块，用于根据所述三维地图利用同步定位和地图创建算法绘制环境二维地图；识别模块，用于基于地图绘制模块所绘制的二维地图区分地图中的可行域与障碍域；路径点分布模块，用于在地图空间上随机散布路径点，并剔除不可行路径点；路径点搜索模块，用于搜索移动导航系统的下一个路径点；检测模块，用于判断移动导航系统是否已经到达目的地。