[实用新型]基于工具车的自主导航系统及工具车

说明书

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

技术领域

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

背景技术

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

实用新型内容

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

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

设置在工具车上的传感器模块、控制模块和运动模块，所述控制模块与所述传感器模块、所述运动模块分别相连接；

所述传感器模块检测工具车距离隧道左壁、右壁的距离，检测工具车行进前方是否存在障碍物和检测障碍物距离工具车左侧、右侧的距离，和检测工具车的行进速度，所述控制模块对所述工具车距离隧道左壁的距离和所述工具车距离隧道右壁的距离的距离差值做模糊化处理，对所述障碍物距离工具车左侧的距离信息、所述障碍物距离工具车右侧的距离信息和所述行进速度信息做模糊化处理，和采用模糊规则对所述经模糊化处理后的信息进行处理，得到在当前状态下工具车左右轮应所述具有的速度和行进转向方向，所述运动模块根据所述应所述具有的速度信息和所述行进转向方向信息，通过履带控制工具车左主动轮、右主动轮在当前状态下应所述具有的速度，和通过调节工具车左主动轮和右主动轮的速度差来控制工具车在当前状态下应所述具有的行进转向方向；

所述传感器模块，包括：

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

所述第一激光传感器设置在工具车车头或车身的左侧，所述第二激光传感器设置在工具车车头或车身的右侧，所述第一超声波传感器设置在工具车车头或车身的左侧，所述第二超声波传感器设置在工具车车头或车身的右侧，所述速度传感器设置在工具车车头或车身上；

所述运动模块，包括：

第一步进电机和第二步进电机；

所述第一步进电机与工具车左主动轮采用履带结构，所述第二步进电机与工具车右主动轮采用履带结构。

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

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

所述数据接收单元接收所述距离隧道左壁的距离信息、所述距离隧道右壁的距离信息、所述障碍物距离工具车左侧的距离信息、所述障碍物距离工具车右侧的距离信息和所述行进速度信息，所述数据处理单元对所述工具车距离隧道左壁的距离和所述工具车距离隧道右壁的距离的距离差值做模糊化处理，对所述障碍物距离工具车左侧的距离信息、所述障碍物距离工具车右侧的距离信息和所述行进速度信息做模糊化处理，所述模糊控制器采用模糊规则对所述经模糊化处理后的信息进行处理，得到在当前状态下工具车左右轮应所述具有的速度和行进转向方向，并将所述应所述具有的速度信息和所述行进转向方向信息输出到运动模块。

其中，所述基于工具车的自主导航系统，还包括：