[发明专利]基于工具车的自主导航系统及工具车

说明书

本发明公开了一种基于工具车的自主导航系统及工具车。其中，所述系统包括：运动模块根据工具车左主动轮和右主动轮应该具有的速度信息和行进转向方向信息，通过履带控制工具车左主动轮、右主动轮在当前状态下应该具有的速度，和通过调节工具车左主动轮和右主动轮的速度差来控制工具车在当前状态下应该具有的行进转向方向。通过上述方式，能够实现工具车能在隧道中自主导航行进到指定位置。

技术领域

本发明涉及工具车技术领域，特别是涉及一种基于工具车的自主导航系统及工具车。

背景技术

目前，为了提高物流运输效率，大多使用工具车作为运输的主要工具，让工具车在预先通过磁导航技术在前进的道路上铺设的导引线上自主导航行进到指定位置。但是，工具车在前进的道路是隧道时，由于隧道中地面环境复杂、运行路径长、运行线路不确定等因素，使得导引线的铺设很难实现，使得工具车无法在隧道中自主导航行进到指定位置。

发明内容

本发明的目的在于提出一种基于工具车的自主导航系统及工具车，能够实现工具车能在隧道中自主导航行进到指定位置。

根据本发明的一个方面，提供一种基于工具车的自主导航系统，包括：

传感器模块、控制模块和运动模块；

所述传感器模块，设置在工具车上，用于检测工具车距离隧道左壁、右壁的距离，检测工具车行进前方是否存在障碍物和检测障碍物距离工具车左侧、右侧的距离，和检测工具车的行进速度；

所述控制模块，设置在工具车上，用于对所述工具车距离隧道左壁的距离和所述工具车距离隧道右壁的距离的距离差值做模糊化处理，对所述障碍物距离工具车左侧的距离信息、所述障碍物距离工具车右侧的距离信息和所述行进速度信息做模糊化处理，和采用模糊规则对所述经模糊化处理后的信息进行处理，得到在当前状态下工具车左右轮应所述具有的速度和行进转向方向；

所述运动模块，设置在工具车上，用于根据所述应所述具有的速度信息和所述行进转向方向信息，通过履带控制工具车左主动轮、右主动轮在当前状态下应所述具有的速度，和通过调节工具车左主动轮和右主动轮的速度差来控制工具车在当前状态下应所述具有的行进转向方向。

其中，所述传感器模块，包括：

第一激光传感器、第二激光传感器、第一超声波传感器、第二超声波传感器和速度传感器；

所述第一激光传感器，设置在工具车车头或车身的左侧，用于检测工具车距离隧道左壁的距离，并发送所述距离隧道左壁的距离信息到控制模块；

所述第二激光传感器，设置在工具车车头或车身的右侧，用于检测工具车距离隧道右壁的距离，并发送所述距离隧道右壁的距离信息到控制模块；

所述第一超声波传感器，设置在工具车车头或车身的左侧，用于检测工具车行进前方是否存在障碍物和检测障碍物距离工具车左侧的距离，并发送所述障碍物距离工具车左侧的距离信息到控制模块；

所述第二超声波传感器，设置在工具车车头或车身的右侧，用于检测工具车行进前方是否存在障碍物和检测障碍物距离工具车右侧的距离，并发送所述障碍物距离工具车右侧的距离信息到控制模块；

所述速度传感器，设置在工具车车头或车身上，用于检测工具车的行进速度，并发送所述行进速度信息到控制模块。

其中，所述控制模块，包括：

数据接收单元、数据处理单元和模糊控制器；

所述数据接收单元，用于接收所述距离隧道左壁的距离信息、所述距离隧道右壁的距离信息、所述障碍物距离工具车左侧的距离信息、所述障碍物距离工具车右侧的距离信息和所述行进速度信息；