[发明专利]基于SLAM技术的车库自主导航装置及导航方法

摘要

本发明公开一种基于SLAM技术的车库自主导航装置及导航方法，该装置包括激光雷达装置、惯性测量单元、微处理器、存储器、显示设备、SLAM子系统和路径规划子系统。本发明利用SLAM技术和导航装置自身携带的传感器，由SLAM子系统对激光雷达获取的距离信息和经IMU数据校正后的激光里程信息进行处理，生成未知环境地图；利用路径规划子系统，调用激光里程信息和SLAM子系统生成地图数据，对汽车驶出车库的路径进行规划，因此无需借助网络等方式获取导航地图，即可实现对车库汽车的自主导航。本发明在卫星信号接收不到或较弱的场景，作为对现有网络导航设备的补充，也可以获得精确的导航效果。

主权项

1.一种基于SLAM技术的车库自主导航装置，其特征在于：其包括微处理器、存储器、激光雷达装置、惯性测量单元、显示设备、SLAM子系统和路径规划子系统；/n所述微处理器对所述激光雷达装置测量数据和所述惯性测量单元测量数据进行处理，在汽车入库时，所述微处理器启动所述激光雷达装置、惯性测量单元并启动所述SLAM子系统，所述微处理器根据所述激光雷达的测量数据构建激光里程信息，并利用所述惯性测量单元测量的数据对所述激光里程信息进行矫正，然后将所述激光雷达的数据和所述矫正后的激光里程信息输入到所述SLAM子系统；在所述汽车停车时，所述微处理器将所述激光里程信息、所述SLAM子系统生成的地图数据保存到所述存储器中后，关闭所述SLAM子系统；在所述汽车离开车库时，所述微处理器调用路径规划子系统对所述汽车驶出车库的路径进行规划；/n所述存储器用于存储所述微处理器、所述SLAM子系统和所述路径规划子系统工作过程中处理和生成的数据；/n所述激光雷达装置用于感知汽车周围环境信息，生成所述汽车距离障碍物的距离信息；/n所述惯性测量单元，用于测量汽车瞬时角速度和瞬时加速度数据；/n所述显示设备用于显示所述微处理器、所述SLAM子系统和所述路径规划子系统工作过程中生成的图形信息和标识；/n所述SLAM子系统，对所述激光雷达获取的距离信息和经IMU数据校正后的所述激光里程信息进行处理，生成未知环境地图；/n所述路径规划子系统，调用所述激光里程信息和所述SLAM子系统生成地图数据，对所述汽车驶出车库的路径进行规划。/n