专利名称：车载激光自动导航系统的制作方法
技术领域：
本实用新型涉及一种导航装置，特别涉及一种车载激光自动导航系统。
背景技术：
在一些特殊场合(如港口货场、海关通道等)，某些特种车辆(如轮胎塔吊、集装箱巡检车等)需要以一定间距紧挨货物(如集装箱、集装箱卡车等)队列前进或后退巡行；为避免碰撞事故发生，须使车辆与货物队列保持在合适的间距范围内。由于人工操控导航的工作量较大、且导航可靠性难以保证，因而有必要加装车辆自动导航装置。现有的自动导航装置按跟踪目标不同，主要分直线式和实测式两类。其中，直线式装置通过车载传感器跟踪预先设置于货物队列侧边的直线标识物(如路面标线、导向围栏、 对射光栅等)，使车辆保持直线行驶来实现自动纠偏；其缺点是现场准备工作量大，货物队列直线度要求较高，导航可靠性和环境适应性较低。实测式装置通过车载传感器跟踪货物队列侧边的轮廓位置，使车辆沿平滑曲线行驶来实现自动导航；其优点是无须现场准备工作，货物队列直线度要求较低，导航可靠性和环境适应性较高。现有的实测式自动导航装置按传感装置不同，主要分机器视觉和激光测距两类。 其中，机器视觉类采用多路车载摄像头，根据目标在两幅图像中的位置关系计算目标的相对运动，如相对运动参数超出规定的最大偏移量，即发出控制指令进行自动转向避障；其缺点是受前景视距影响较大，易受外界杂光干扰，图像配准需明显的道路标识，车速较快时摄像易丢帧；因而仅适用于低速导航场合，且导航可靠性和环境适应性不高。激光测距类大多采用激光单点测距型式，分别在车头和车尾各加装一只激光单点测距传感器，通过将各传感器的实测值与预设值范围进行比较，适时发出控制指令进行自动转向避障；虽然该型式控制简单易行、环境适应性好、且系统成本较低，但由于两点测距的信息量较小，因而同样仅适用于低速导航场合，且导航可靠性仍然不高。
发明内容本实用新型是针对现有技术的不足的问题，提出了一种车载激光自动导航系统， 能利用车载激光扫描测距仪测得的货物队列扫描测距信号、车辆动力系统导出的行车状态信号、自动转向机构反馈的转向位置信号、以及车辆的车体结构参数等多种信息，依据主动导航控制律实现车辆自动转向控制，使车辆与货物队列保持在安全距离范围内，避免车辆进退时与货物队列发生碰撞。本实用新型的技术方案为一种车载激光自动导航系统，包括激光扫描测距仪、控制器、自动转向机构，激光扫描测距仪得到的扫描测距信号、车辆动力系统导出的行车状态信号、以及自动转向机构反馈的转向位置信号通过通讯接口输入控制器，控制器根据主动导航控制律处理信号后，输出驱动信号对自动转向机构进行伺服控制；当超出转向控制范围或系统出现故障时，控制器输出报警和停车信号。所述控制器可选可编程控制器、运动控制器、或工控机。[0008]所述自动转向机构为带行程开关或位置反馈的直流永磁电动推杆。本实用新型的有益效果在于本实用新型车载激光自动导航系统，利用车载激光扫描测距仪测得的货物队列扫描测距信号、车辆动力系统导出的行车状态信号、自动转向机构反馈的转向位置信号、以及车辆的车体结构参数等多种信息，依据自动导航控制律实现车辆自动转向控制，使车辆与货物队列保持在安全距离范围内，避免车辆进退时与货物队列发生碰撞；改善了现有车用自动导航装置的诸多不足，具有无须现场准备、导航可靠性高、适用范围广等特点。
图1为本实用新型车载激光自动导航系统结构框图；图2为本实用新型车载激光自动导航系统中集装箱巡检车的后视图；图3为本实用新型车载激光自动导航系统中集装箱巡检车的俯视图；图4为本实用新型车载激光自动导航系统中自动导航控制律的流程图。
具体实施方式
在图1、2和3所示实施例中，本实用新型中控制系统主要由激光扫描测距仪1、 控制器2、自动转向机构3等部件构成；其中，激光扫描测距仪1包括红外脉冲式激光扫描测距仪、防尘罩、防雨棚等组件，控制器2可选可编程控制器、运动控制器、或工控机等，自动转向机构3为带行程开关(或位置反馈)的直流永磁电动推杆。控制器2通过支架安装于巡检车4的驾驶室41内；自动转向机构3通过万向节安装于巡检车驾驶室内的转向盘上；为减少激光扫描测距仪1的加装数量、简化结构和降低成本，考虑到国际标准集装箱的宽度相同、且集装箱卡车5 —般左右对称，故仅须对集卡队列的集装箱左侧面进行扫描测距；为不影响龙门跨臂43的折叠摆放，激光扫描测距仪1通过支架安装于巡检车控制室箱体42右前顶部；为避免碰撞龙门跨立臂，巡检车右侧与集卡左侧间的最大安全距离应小于龙门跨臂内侧宽度与集卡宽度之差；为避免激光扫描测距仪1进入最小测距盲区、且保证安全距离范围内不同高度和规格的集装箱均能被扫到，可使激光扫描面11相对水平面下倾一定角度；为进一步降低成本，在满足跟踪响应的前提下，可选用较小最大探测距离的激光扫描测距仪1。在图4所示实施例中，本实用新型中主动导航控制律的控制流程是将激光扫描测距仪1得到的扫描测距信号(包括障碍物距离-扫描角序列)通过高速通讯接口输入控制器2，并将巡检车动力系统导出的行车状态信号(包括前进、后退、车速等)、以及自动转向机构导出的转向位置信号(包括行程、回正等)输入控制器2 ；控制器2根据测距仪1安装位置和扫描面下倾角等信息，对扫描测距信号作三角函数运算后得出集卡队列侧边的轮廓数据，通过识别算法滤除集装箱队列左侧以外的轮廓数据，再对所剩数据作线性拟合运算后得出跟踪路线；控制器2根据巡检车的车体结构参数(包括轴距、前/后悬长、轮边距等)和行车状态信号，得出使行车轨迹符合跟踪路线的转向角度；控制器2根据转向位置信号，适时输出转向行程控制指令对自动转向机构3进行伺服控制，使巡检车右侧与集卡队列左侧保持在安全距离范围内，避免巡检车进退时与集卡队列发生碰撞；当超出转向控制范围或系统出现故障时，控制器2输出停车和报警信号；在极端失控状况下，依靠巡检通道内设的
4接触式防撞开关实现被动避障保护。另外，为预防龙门跨立臂与少数非标超宽集装箱碰撞， 巡检车前进时通过对集卡队列间集装箱后端面的扫描测距，可提前得到前方集装箱的宽度信息，以便适时调整巡检车右侧与集卡左侧间的最大安全距离；巡检车后退时可通过前进时预存的宽度信息来实现同样功能。
权利要求1.一种车载激光自动导航系统，其特征在于，包括激光扫描测距仪、控制器、自动转向机构，激光扫描测距仪得到的扫描测距信号、车辆动力系统导出的行车状态信号、以及自动转向机构反馈的转向位置信号通过通讯接口输入控制器，控制器根据主动导航控制律处理信号后，输出驱动信号对自动转向机构进行伺服控制；当超出转向控制范围或系统出现故障时，控制器输出报警和停车信号。
2.根据权利要求1所述车载激光自动导航系统，其特征在于，所述控制器可选可编程控制器、运动控制器、或工控机。
3.根据权利要求1所述车载激光自动导航系统，其特征在于，所述自动转向机构为带行程开关或位置反馈的直流永磁电动推杆。
专利摘要本实用新型涉及一种车载激光自动导航系统，利用车载激光扫描测距仪测得的货物队列扫描测距信号、车辆动力系统导出的行车状态信号、自动转向机构反馈的转向位置信号、以及车辆的车体结构参数等多种信息，依据自动导航控制律实现车辆自动转向控制，使车辆与货物队列保持在安全距离范围内，避免车辆进退时与货物队列发生碰撞；改善了现有车用自动导航装置的诸多不足，具有无须现场准备、导航可靠性高、适用范围广等特点。
文档编号G05D1/02GK202102313SQ20112019792
公开日2012年1月4日 申请日期2011年6月14日 优先权日2011年6月14日
发明者曹民 申请人:上海理工大学