CN209008730U - 一种基于视觉传感器的重型导引车 - Google Patents

Abstract

本实用新型公开了一种基于视觉传感器的重型导引车，包括重型车本体和自动导引系统；重型车本体包括多个轮组，每一轮组上分别安装有液压悬挂、角度传感器、升降电磁阀和转向电磁阀；且位于重型车本体的四个角上的液压悬挂分别安装有高度传感器；自动导引系统包括通信转换模块、车载控制器和分别安装于重型车本体中心线头尾的两套视觉传感器；其中该视觉传感器带有自动变焦镜头，检测距离能够根据车辆升降情况自动对焦，自适应检测算法可满足车辆自动升降作业需求；且该视觉传感器还带有微控制器并集成算法，能够实时扫描并解析二维码地标信息。同时本实用新型配置了分布式电驱动轮组和液压悬挂，控制精度高并具有良好的路面补偿能力。

Description

一种基于视觉传感器的重型导引车

技术领域

本实用新型涉及重型AGV(Automated Guided Vehicle，自动导引运输车) 技术领域，具体是一种具有升降功能及多模式转向功能、能够适应室内室外运输的基于视觉传感器的重型导引车。

背景技术

随着智能化产业的发展，重载运输领域自动导引的需求越来越多。如船厂、变压器厂、钢厂等，尤其是工业制造自动化程度较高的行业，对大型构件自动化转运的需求更为迫切。在自动导引车行业，常见的自动导引车以小型车辆为主，不能满足大吨位自动作业发展需求。同时现有的导引定位方法大多适用于小型AGV。如常见的色带、二维码传感器，此类引导定位方法检测范围小，检测距离短，不适合具有升降功能的重型导引车。

实用新型内容

针对上述现有技术中存在的问题，本实用新型提供一种具有升降功能及多模式转向功能的基于视觉传感器的重型导引车；该重型导引车包括重型车本体和自动导引系统；其中，所述重型车本体包括多个轮组，每一所述轮组上分别安装有液压悬挂、角度传感器、升降电磁阀以及转向电磁阀；且位于所述重型车本体的四个角上的液压悬挂分别安装有高度传感器；

此外，所述重型车本体还包括安装于该重型车本体的动力单元上的电池包和电池管理系统；其中，所述电池管理系统与所述电池包电连接，且所述电池包设置有自动充电装置；所述多个轮组中的其中一部分轮组为电驱动轮组；且每一所述电驱动轮组分别与驱动电机控制器电连接，所述驱动电机控制器与所述电池包电连接；

所述自动导引系统包括通信转换模块、车载控制器以及用于扫描并解析二维码地标的位置信息和预设信息的两套视觉传感器；所述两套视觉传感器分别通过安装支架安装于所述重型车本体的中心线头尾，其检测面与地面平行；且所述视觉传感器带有自动变焦镜头，其检测距离能够根据车辆升降情况自动对焦；同时所述视觉传感器还带有微控制器并集成算法，能够实时扫描并解析二维码地标的位置信息和预设信息；而所述通信转换模块和车载控制器则均安装于所述重型车本体的控制箱中；

所述视觉传感器的电源线与所述电池包电连接，所述视觉传感器的通信线通过所述通信转换模块与所述车载控制器电连接；所述车载控制器的输入端口与各角度传感器、各高度传感器分别电连接，所述车载控制器的输出端口与各转向电磁阀、各升降电磁阀分别电连接；同时所述车载控制器与所述驱动电机控制器和所述电池管理系统分别电连接。

进一步地，所述电驱动轮组包括两个通过插装桥连接的橡胶轮，所述插装桥上安装有驱动电机，所述驱动电机与所述驱动电机控制器电连接；且所述插装桥内置有与两个所述橡胶轮相连的减速机和差速器。

进一步地，所述重型车本体设置有十二个轮组，其中四个为电驱动轮组。

进一步地，所述通信转换模块为RS232串口转CAN通信模块，用于将两个视觉传感器输出的RS232串口信号转换为一路CAN总线信号；所述车载控制器通过CAN总线分别与所述通信转换模块、所述驱动电机控制器以及所述电池管理系统电连接。

进一步地，所述二维码地标采用激光打印机在钢板上打印而成，并通过双面胶固定在地面上。

进一步地，多个所述二维码地标以预设的固定间距呈网格状铺设于重型导引车所在工作区域的地面上，且多个二维码地标同向分布。

本实用新型的重型导引车配置有负载敏感液压转向系统，应用全轮独立转向技术。每个轮组分别配置有液压悬挂系统，在路面不平整时具有很好的补偿能力，对液压悬挂进行分组，可以实现整体升降和单点升降功能。配置锂电池及自动充电装置，采用分布式电驱动方式。单车运输吨位可达几十吨，多台车协同运输可达上千吨。

并且本实用新型通过分别安装于重型导引车中心线头尾的两套视觉传感器，在一定检测距离内自动对焦识别二维码地标，实时扫描并解析二维码地标的位置信息和预设信息。并通过二维码地标的位置信息计算出车辆在大地坐标系中的实时位置，通过两套视觉传感器的位置信息计算出车辆在大地坐标系中的实时姿态；进而根据车辆实际位姿与目标位姿的偏差，结合上位机路径规划指令控制车辆自动作业。其中的视觉传感器的检测距离能够根据车辆升降情况自动对焦，可适应室内环境和室外环境应用需求；且具有应用灵活，检测范围大，读取速度快的特点，适用于大型车辆高速及低速运行需求。

附图说明

图1为本实用新型中的二维码地标的布置示意图；

图2为本实用新型中的自动导引系统的系统框图；

图3为本实用新型中的重型导引车的系统布置图；

图4为本实用新型中的重型导引车的另一系统布置图；

图5为本实用新型中的液压悬挂及电驱动轮组的结构示意图。

附图标记说明：

1：二维码地标，2：安装支架，3：视觉传感器，4：通信转换模块，

5：车载控制器，6：电池管理系统，7：驱动电机控制器，8：电池包，

9：电驱动轮组，10：液压悬挂，11：高度传感器，12：角度传感器，

13：自动充电装置，9-1：插装桥，9-2：驱动电机，9-3：橡胶轮，

10-1：回转支承，10-2：升降油缸，10-3：涡轮蜗杆转向机构。

具体实施方式

为使本实用新型实施例的目的、技术方案和优点更加清楚，下面将结合本实用新型实施例的附图，对本实用新型实施例的技术方案进行清楚、完整地描述，显然，所描述的实施例是本实用新型的一部分实施例，而不是全部的实施例。基于本实用新型中的实施例，本领域普通技术人员在没有做出创造性劳动的前提下所获得的所有其他实施例，都属于本实用新型保护的范围。

请参阅图1至图5，本实施例提供一种基于视觉传感器的重型导引车，该重型导引车包括重型车本体和自动导引系统；其中，所述重型车本体包括同步控制液压升降系统、电子多模式负载敏感液压转向系统和十二个轮组，其中每一轮组上分别安装有液压悬挂10、角度传感器12、升降电磁阀以及转向电磁阀；每个液压悬挂10均包含升降油缸10-2、回转支承10-1、涡轮蜗杆转向机构10-3。通过车载控制器5可控制液压悬挂10的涡轮蜗杆转向机构10-3 自由转向，实现整车不同转向模式。多个液压悬挂10可通过液压管路及开关阀进行分组，可通过升降电磁阀控制升降油缸10-2伸缩，实现车辆总体升降和单点升降功能。且位于重型车本体的四个角上的液压悬挂10分别安装有高度传感器11；可通过车载控制器5实现升降闭环同步控制。

此外，所述重型车本体还包括安装于该重型车本体的动力单元上的电池包8和电池管理系统6；其中，所述电池管理系统6与所述电池包8电连接，且所述电池包8设置有自动充电装置13；上述十二个轮组中的四个轮组为电驱动轮组9；电驱动轮组9包括两个通过插装桥9-1连接的橡胶轮9-3，所述插装桥9-1上安装有驱动电机9-2，所述驱动电机9-2与驱动电机控制器7电连接；且所述插装桥9-1内置有与两个所述橡胶轮9-3相连的减速机和差速器。所述驱动电机控制器7与所述电池包8电连接。通过驱动电机控制器7可对每个电驱动轮组9的转速及扭矩进行闭环控制。

所述自动导引系统包括通信转换模块4、车载控制器5以及用于扫描并解析二维码地标1的位置信息和预设信息的两套视觉传感器3；两套视觉传感器 3分别通过安装支架2安装于所述重型车本体的中心线头尾，所述通信转换模块4和所述车载控制器5均安装于所述重型车本体的控制箱中；其中的安装支架2为可调支架，其焊接在车架上，与车辆装载面平齐，保证不影响车辆装卸货物。并伸出车头与车尾，保证视觉传感器3检测面不被遮挡。

此外，本实施例中在可调支架上设置有加强筋，保证视觉传感器3安装稳定。同时可调支架用于安装视觉传感器3的小支架可以微调视觉传感器3 水平方向的安装角度，保证视觉传感器3安装角度与车辆姿态偏差为零。

所述视觉传感器3的电源线与所述电池包8电连接，所述视觉传感器3 的通信线通过所述通信转换模块4与所述车载控制器5电连接；所述车载控制器5的输入端口与各角度传感器12、各高度传感器11分别电连接，所述车载控制器5的输出端口与各转向电磁阀、各升降电磁阀分别电连接；同时所述车载控制器5与所述驱动电机控制器7和电池管理系统6分别电连接。

上述二维码地标1采用激光打印机在薄钢板上打印，保证强度。且薄钢板进行表面处理，改变其反光特性，使视觉传感器3能够可靠快速地读取。二维码地标1制作完成后用双面胶固定在地面上，从而在保证稳定性的基础上不损坏原有路面，具有灵活的应用性。铺设时多个二维码地标是以预设的固定间距呈网格状铺设于重型导引车所在工作区域的地面上，且多个二维码地标同向分布，如图1所示；具体地，本实施中所采用的二维码地标的大小为5mm*5mm，铺设时各二维码地标的横向间距和纵向间距均为500mm。

此外，本实施例中对多个二维码地标1按照从下至上，从左至右的顺序依次进行编号。如从下到上第n排，从左到右第m排的二维码地标的编号为 a_nm。并将二维码地标的编号作为该二维码地标的预设信息存储进该二维码地标中；如a_nm号的二维码地标的预设信息为NM。

进一步地，上述视觉传感器3采用康耐视公司DM360系列产品，带有小型控制器并集成算法，可快速扫描可视范围内的二维码地标信息。带有液态自动变焦镜头，其检测距离能够根据车辆升降情况自动对焦，自适应检测算法满足车辆自动升降作业需求；检测距离大于1000mm，可适应800mm以上的距离变化检测需求。检测范围大于500mm*500mm。且该视觉传感器3自带光源，在光线不足时仍能快速检测，可满足室内外导引需求。

具体地，当车辆降到最低时，视觉传感器的检测距离为1000m，车辆上升到最高时，视觉传感器的检测距离为1600mm。视觉传感器的视觉范围随着检测距离的增大而增大，其中最小视野范围为600mm*800mm。因此当二维码地标的铺设间距为500mm*500mm时，能够保证视觉传感器每个时刻均能检测到至少一个二维码地标，从而到达实时控制的目的。

上述通信转换模块4为RS232串口转CAN通信模块，用于将两个视觉传感器3输出的RS232串口信号转换为一路CAN总线信号传输给上述车载控制器5；该车载控制器5选用易福门公司CR0234可编程控制器，防护性高，自带I/O，其通过CAN总线分别与通信转换模块4、驱动电机控制器7以及电池管理系统6电连接。该车载控制器5的自动导引程序包括信号处理模块、逻辑控制模块、安全保护模块、避障模块、通信模块、监测诊断模块等。

下面对本实施例中的基于视觉传感器的重型导引车实现自动导引的原理和过程详细说明如下：

首先通过分别安装于重型导引车中心线头尾的两个视觉传感器3，实时扫描并解析重型导引车前后视野范围内的二维码地标1的位置信息和预设信息；

其中二维码地标的位置信息包括二维码地标的像素位置信息、偏角信息以及最小单位像素信息；进一步地，二维码地标的像素位置信息为该二维码地标的中心点位于正在扫描该二维码地标的当前视觉传感器所对应的视野坐标系中的X坐标和Y坐标，用像素表示；偏角信息为该二维码地标相对于视野坐标系的偏角；最小单位像素信息为该二维码地标的最小单位在当前视觉传感器的视野范围内的像素值；其中的视野坐标系是以视觉传感器的视野范围的左前点为坐标原点，以视野范围的顶边为X轴，左侧边为Y轴的坐标系。

当视觉传感器3采集到二维码地标1的信息后，将采集到的信息传输给车载控制器5，由车载控制器5根据二维码地标1的位置信息计算出二维码地标1的中心点在视觉传感器3所对应的视野坐标系中的坐标；

需要说明的是，随着车辆的升降，视觉传感器3的视野大小会发生变化，进而二维码地标1的最小单位像素值随之变化。因此结合视觉传感器3固有的像素信息、二维码地标1的最小单位边长信息就可计算出视觉传感器3视野大小。然后根据视觉传感器3采集到的二维码地标1的像素位置信息就可以计算二维码地标1的中心点在视觉传感器3所对应的视野坐标系中的坐标。

具体计算过程为：由视觉传感器3所采集到的当前二维码地标的最小单位像素a、所述当前二维码的最小单位边长信息b以及该视觉传感器3的像素分辨率c，根据该视觉传感器3成像的线性关系，计算出该视觉传感器3的视野大小d＝c*b/a；然后根据所述当前二维码地标的像素位置信息，由该视觉传感器3的像素分辨率c及视野大小d成像比例关系，计算出所述当前二维码地标的中心点在该视觉传感器3所对应的视野坐标系中的坐标。

当计算出二维码地标1的中心点在视野坐标系中的坐标后，车载控制器5 进一步根据视觉传感器3的安装位置和二维码地标1的中心点在视觉传感器3 所对应的视野坐标系中的坐标，根据坐标系平移旋转公式计算出二维码地标1 的中心点在车辆坐标系中的坐标^VP；同时根据二维码地标的预设信息可以计算出该二维码地标的中心点在大地坐标系中的坐标^GP。

需要说明的是，上述车辆坐标系是以车辆的几何中心为坐标原点，以车辆纵向中线为Y轴，以车辆前进方向为Y轴正向的坐标系。上述大地坐标是以位于二维码地标矩阵左下角的二维码地标，也即a₁₁号二维码地标的几何中心为坐标原点，以二维码地标矩阵的正向为Y轴正向的坐标系。由于二维码地标是以固定间距同向网格状铺设于地面，按照顺序对二维码地标进行编号，并将二维码地标的编号作为预设信息输入至二维码地标，因此可根据二码地标的编号计算得到该二维码地标在大地坐标系中的坐标。

根据坐标系平移旋转公式，可知：其中为B坐标系相对于A坐标系的旋转矩阵，为B坐标系相对于A的平移矩阵，^AP为 P点在A坐标中的位姿，^BP为P点在B坐标中的位姿。据此，上述计算二维码地标1的中心点在车辆坐标系中的坐标^VP的过程具体为：

由视觉传感器3的安装位置得到视觉传感器3所对应的视野坐标系相对于所述车辆坐标系的旋转角度为0；由视觉传感器3的视野大小d、安装支架 2尺寸、重型导引车尺寸求得视觉传感器3所对应的视野坐标系相对于车辆坐标系的平移矩阵，由二维码地标1的中心点在该视觉传感器所对应的视野坐标系中的坐标、该视野坐标系相对于车辆坐标系的旋转矩阵和平移矩阵，根据坐标系平移旋转公式计算出二维码地标1中心点在车辆坐标系中的坐标^VP。

当计算出二维码地标1的中心点对应的坐标^VP和坐标^GP后；车载控制器5进一步根据二维码地标1的中心点对应的坐标^VP、坐标^GP以及车辆坐标系与大地坐标系的偏差，根据坐标旋转与平移变换方法，求得车辆坐标系与大地坐标系的位置偏差，即车辆实时位置与目标位置的偏差；

需要说明的是，由于视觉传感器3通过安装支架2安装于车辆前后中心线，且视觉传感器3视野相对于车辆姿态没有偏差，因此二维码地标1相对于视野坐标系的偏角就等同于二维码地标1相对于车辆坐标系的偏差。设大地坐标系正方向为二维码地标正方向，由此可知视觉传感器3实时反馈的偏差信息即为车辆坐标系与大地坐标系的偏差。因此上述求得车辆实时位置与目标位置的偏差的过程具体为：

将二维码地标1的偏角信息作为大地坐标系相对于车辆坐标系的旋转角θ，根据旋转角θ求得大地坐标系相对于车辆坐标系的旋转矩阵根据旋转矩阵当前二维码地标的中心点在车辆坐标系中的坐标^VP、当前二维码地标的中心点在大地坐标系中的坐标^GP，求得大地坐标与车辆坐标系的平移矩阵即车辆实时位置与目标位置的偏差。

此外，车载控制器5还可以由前后视觉传感器各自所解析到的前后二维码地标的位置信息和预设信息分别计算出前后二维码地标的中心点在相应视野坐标系中的坐标和前后二维码地标的中心点在大地坐标系中的坐标，然后根据坐标变换方法得到前后视觉传感器各自对应的视野坐标系的原点在大地坐标系中的坐标；继而求得车辆坐标系与大地坐标系的姿态偏差，即车辆实时姿态与目标姿态偏差；

需要说明的是，由于重型车体型较长，用视觉传感器3直接读取的偏差信息进行车辆轨迹误差校正控制精度不高。因此本实施例通过前后视觉传感器的位置信息计算车辆在大地坐标系中的偏差信息以提高精度。

其中，由前后传感器读取的二维码地标的位置信息可以计算出前后二维码地标的中心点在视野坐标系中的坐标，由前后传感器读取的二维码地标的预设信息可以得到前后二维码地标的中心点在大地坐标系中的坐标，然后依据坐标变换方法就可以得到前后传感器视野坐标系原点在大地坐标中坐标。由于前后传感器视野坐标系原点连线与车辆纵向中心线平行，从而可得车辆坐标系与大地坐标系姿态偏差，即车辆实时姿态与目标姿态的偏角。

最后当计算出了车辆的实时位姿和目标位姿的偏差后，车载控制器5就可以根据计算出的车辆实时位姿与目标位姿的偏差，调用闭环控制算法控制重型导引车自动作业。也即视觉传感器3将读取的二维码地标1的最小单位像素信息、像素位置信息、偏差信息、预设信息通过串口发送给通信转换模块4，通信转换模块4将信息转换为CAN总线信息发送给车载控制器5，车载控制器5根据上述定位计算方法运算得到车辆实时位姿与目标位姿的偏差，调用闭环控制算法分别控制车辆转向电磁阀，升降电磁阀，驱动电机控制器7 动作，实现重型车自动作业功能。

同时本实用新型的重型导引车在自动导引定位时，可以通过无线通信系统接收上位机调度信息同时控制多台车辆协同工作，也可以在车载控制器5 中预设作业任务，完成单机自动导引运输。

本实用新型设计了一种具有升降功能及多模式转向功能、能够适应室内室外运输的基于视觉传感器的重型导引车。配置液压悬挂，具有良好的补偿能力。配置液压升降系统，具备自动升降作业功能。配置分布式电驱动轮组，结构紧凑控制精度高。可适用于重型车室内室外自动导引需求，定位精度达到毫米级，检测距离可以自动调节，适用于车辆自动升降功能控制需求，检测范围大，可满足大型车辆运动控制需求。相比磁钉复杂的基础建设要求，特殊工艺的二维码地标在兼具稳定性的同时，可以满足灵活扩展的应用需求。

需要说明的是，本实用新型实施例中，术语“包括”、“包含”或者其任何其他变体意在涵盖非排他性的包含，从而使得包括一系列要素的过程、方法、物品或者终端设备不仅包括那些要素，而且还包括没有明确列出的其他要素，或者是还包括为这种过程、方法、物品或者终端设备所固有的要素。在没有更多限制的情况下，由语句“包括一个……”限定的要素，并不排除在包括所述要素的过程、方法、物品或者终端设备中还存在另外的相同要素。

以上仅为本实用新型的优选实施例而已，并不用于限制本实用新型，对于本领域技术人员来说，本实用新型可有各种更改和变化。凡在本实用新型的精神和原则之内，所作的任何修改、等同替换、改进等，均应包含在本实用新型的保护范围之内。

Claims (6)

1.一种基于视觉传感器的重型导引车，其特征在于，所述重型导引车包括重型车本体和自动导引系统；

其中，所述重型车本体包括多个轮组，每一所述轮组上分别安装有液压悬挂、角度传感器、升降电磁阀以及转向电磁阀；且位于所述重型车本体的四个角上的液压悬挂分别安装有高度传感器；

此外，所述重型车本体还包括安装于该重型车本体的动力单元上的电池包和电池管理系统；其中，所述电池管理系统与所述电池包电连接，且所述电池包设置有自动充电装置；所述多个轮组中的其中一部分轮组为电驱动轮组；且每一所述电驱动轮组分别与驱动电机控制器电连接，所述驱动电机控制器与所述电池包电连接；

所述自动导引系统包括通信转换模块、车载控制器以及用于扫描并解析二维码地标的位置信息和预设信息的两套视觉传感器；所述两套视觉传感器分别通过安装支架安装于所述重型车本体的中心线头尾，其检测面与地面平行；且所述视觉传感器带有自动变焦镜头，其检测距离能够根据车辆升降情况自动对焦；同时所述视觉传感器还带有微控制器并集成算法，能够实时扫描并解析二维码地标的位置信息和预设信息；而所述通信转换模块和车载控制器则均安装于所述重型车本体的控制箱中；

所述视觉传感器的电源线与所述电池包电连接，所述视觉传感器的通信线通过所述通信转换模块与所述车载控制器电连接；所述车载控制器的输入端口与各角度传感器、各高度传感器分别电连接，所述车载控制器的输出端口与各转向电磁阀、各升降电磁阀分别电连接；同时所述车载控制器与所述驱动电机控制器和所述电池管理系统分别电连接。

2.如权利要求1所述的重型导引车，其特征在于，所述电驱动轮组包括两个通过插装桥连接的橡胶轮，所述插装桥上安装有驱动电机，所述驱动电机与所述驱动电机控制器电连接；且所述插装桥内置有与两个所述橡胶轮相连的减速机和差速器。

3.如权利要求1所述的重型导引车，其特征在于，所述重型车本体设置有十二个轮组，其中四个为电驱动轮组。

4.如权利要求1所述的重型导引车，其特征在于，所述通信转换模块为RS232串口转CAN通信模块，用于将两个视觉传感器输出的RS232串口信号转换为一路CAN总线信号；所述车载控制器通过CAN总线分别与所述通信转换模块、所述驱动电机控制器以及所述电池管理系统电连接。

5.如权利要求1所述的重型导引车，其特征在于，所述二维码地标采用激光打印机在钢板上打印而成，并通过双面胶固定在地面上。

6.如权利要求1所述的重型导引车，其特征在于，多个所述二维码地标以预设的固定间距呈网格状铺设于重型导引车所在工作区域的地面上，且多个二维码地标同向分布。