技术领域
本发明涉及一种码头集装箱自动化技术领域的方法,具体是一种自动化无 人堆场“吊具-集卡-集装箱”定位的多激光雷达协同工作与数据处理方法。
背景技术
集装箱码头生产的自动化是未来港口装卸的发展趋势,受到世界各大港口 的重视。当今已经建成的全自动化集装箱码头中,采用AGV(全自动无人驾驶自 动导向搬运车)实现码头内集装箱的
水平运输,这样当AGV运行到RMG(轨道龙
门起重机)下后,只需通过定位
传感器,便可方便准确的实现AGV的定位。但 是在自动化堆场建设初期,由于财
力和技术上的不成熟,一般只会在港口部分 区域的堆场采用自动化装卸技术,进行试验性生产,局部实现集装箱生产的自 动化,因而不可能对堆场内的集装箱运输采用AGV;而且,由于国内的集装箱陆 路运输主要为集卡,码头集装箱运输表现为内集卡与外集卡并存的一种模式, 因而,即使将内集卡采用AGV替代,也无法避免RMG对外集卡的装卸,从而需 要实现RMG对集卡的准确对箱定位。
为适应现有的集装箱码头的生产条件和集装箱自动化装卸的发展需要,目 前一般多采用单个3D激光雷达对物体进行非
接触式扫描测量,来进行设定目标
位置与
姿态的精确测量与定位。但是单个激光雷达(以下简称LR)在只能从一 个视
角进行扫描测量,对于被遮挡部分地轮廓和形貌只能通过模型进行猜测判 断。而且
扫描仪的扫描
精度与速度直接受到扫描棱镜转动精度、
三维扫描电机 转动速度及精度的制约,加上
软件处理
算法和
硬件控制技术简单,扫描识别能 力非常有限。同时由于一个激光扫描器工作,系统存在错误冗余工作性能不足。 因此,迫切需要一种能够快速准确的实现RMG吊具-集卡对箱的多激光雷达协 同工作处理的新模式与数据处理方法,并能够提供较强的冗余容错能力。
经对
现有技术的文献检索发现,郑德华等在《测绘工程》[(2005) 14(2):32-34,56]上发表的“三维激光扫描仪及其测量误差影响因素分析”, 将三维激光扫描技术分为径向三维激光雷达、
相位干涉法扫描系统和三角法扫 描系统三种类型。并且从仪器误差、与目标物体反射面有关的误差和外界环境 条件影响三个方面分析了三维激光扫描系统误差影响。对径向三维激光雷达器 的测量误差影响因素进行了较为全面地理论分析,并指出了测距误差和扫描角 误差是三维激光扫描误差的主要误差源。但是还未见到有关自动化堆场中实现 RMG对集卡的对箱定位系统中多激光雷达协同工作处理工作模式和数据处理方 法的论述或者相关应用的报道。
发明内容
本发明的目的是针对现有单激光雷达定位处理技术中的系统响应速度不 够,错误冗余可靠性差的不足,提供一种多激光雷达协同工作与数据处理方法。 本发明是由多激光雷达组成的对集装箱
卡车锁头及集装箱锁孔的快速协同扫描 的新工作模式与相应的数据处理新方法,使RMG在大车运行方向的运动受到限 制的情况下,快速完成吊具对集卡的精确对箱定位,从而实现RMG对集卡的集 装箱自动化快速装卸,系统具有极强的冗余容错能力。
本发明具体通过以下技术方案实现的,本发明采用多激光雷达系统(以下 简称MLRS),并通过激光雷达协同工作、目标分
块扫描、扫描数据动态加权处理、 扫描雷达故障自动屏蔽和系统结构自动调整五个技术来实现,其中:采用雷达 控制与主处理模块为每个雷达生成对应的雷达
数据采集子线程和雷达数据处理 子线程;采用雷达状态监控与故障处理模块对系统中每个激光雷达的状态进行 实时的故障监测、诊断,并且对其中的故障激光雷达进行功能屏蔽;采用系统 状态监控模块监测多激光雷达系统中的各个硬件设备的工作状态(包括各个激 光雷达、驱动雷达实现三维扫描的
伺服电机、电机运动控制卡、各个数据传输
接口等)并进行实时显示与报警,各个模块均由独立线程来实现,各模块间通 过内存共享来实现参数传递与信息交互。在雷达控制与主处理模块的协调控制 下,各个雷达并行独立完成目标分块扫描与扫描数据动态加权处理;系统运行 中实时地对每个雷达的采集数据进行有效性验证,如果某个激光雷达发生故障, 则终止该雷达线程并屏蔽其功能,并将雷达状态反馈给系统状态显示模块;雷 达控制与主处理模块根据系统拓扑结构,自适应进行坐标匹配与误差补偿的动 态数据处理,完成对目标多个表面的扫描识别任务:
以下对本发明中的内容作进一步的说明:
1.激光雷达协同工作
每个LR均通过独立的线程控制,MLRS并非按次序的操作每个LR进行扫描, 而是在MLRS雷达控制与主处理模块的控制下,通过同步多个雷达的运行动作, 各雷达协同工作完成扫描任务。在此模式下,即使多个LR同时工作,扫描时间 也不会大于单个LR扫描时间。MLRS对各LR数据实时地并行采集与处理,极大 地提高了数据处理速度,并保持各LR间的高度独立性。
MLRS可以通过同步两个或两个以上LR的运行动作(扫描角度、扫描速度等) 来实现更高级的应用功能(例如测量传送带上物体或
流体的体积、
质量等等), 系统具有很强的可扩展性。
2.目标分块扫描
每个LR并不对
视野内的目标面进行完整扫描,而是由MLRS设定每个雷达 的扫描区域(不完全扫描),这样可以显著提高扫描速度。通过安装多个LR,可 以使目标物体所有外表面都在MLRS的视野范围内。
MLRS根据待扫描目标的外形,设定重要区域分布及重叠率,计算出各个雷 达的扫描角度范围,用各雷达的扫描区域合并来
覆盖整个待扫描范围。用合适 的扫描重叠区域覆盖重要目标区域,对重叠区域内数据进行误差补偿运算,显 著提高了扫描精度。
通过安装并设置多个LR扫描区域重叠,可以使扫描对象的每个表面都有2 个或以上LR可以扫描监测到。对于集装箱目标,可完整的识别到各个锁孔或锁 头的精确位置。
MLRS根据任务要求的扫描精度和速度以及当前的拓扑结构,通过优化配置 来动态确定每个工作LR的扫描区域,来适应不同的应用场合。
3.扫描数据动态加权处理
采用多个LR从不同角度扫描的方式,将不同视角的数据按照基于神经网络 的动态权值分配算法进行加权处理,最终生成补偿误差后的目标轮廓坐标,大 幅提高数据精度。
具体工作步骤如下:
1)在系统运行前,利用神经网络技术,根据现场实测数据建立基于距离和 反射率的初始权值表;
2)神经网络采用MLP(多层
感知器)结构,训练算法采用SDBP(Steepest Descent Back Propagation)算法,即最速下降反向传播算法。网络的输入为 距离与反射率,输出为对应的数据权值(
置信度),距离LR越近、反射率越大 的数据权值越大。
3)数据处理主模块从雷达状态监控模块获得各LR状态,获得当前正常工 作的LR数目;
4)为每个正常LR产生对应的数据处理子线程,对采集到的距离数据值查 询初始权值表,插值计算对应权值,计算出距离置信范围,完成后置位“处理 完毕
信号量”。
5)数据处理主模块等待所有正常LR处理完毕后,根据当前MLRS拓扑结构 对目标点进行绝对方式的坐标匹配,即使用预先设定的公共
坐标系进行匹配;
6)对各重合点采用误差补偿处理算法,计算出误差补偿后的目标坐标值。
由于此权值分配算法基于目标点与LR的相对距离和目标反射率来计算,使 得测量距离值较小的、目标反射率较大的测量数据可以获得较大的权值,经过 误差补偿计算后显著提高了扫描精度。
4.扫描雷达故障自动屏蔽
当某些LR因故障而被关闭时,可以屏蔽这些失效的LR,系统在不停机的情 况下,使用其它LR继续完成扫描任务。遍历正常LR链表,对每个LR的采集数 据进行有效性验证,如果该LR发生故障则终止此LR线程,将其加入故障LR链 表,并在系统状态监控模块显示故障且报警。
如果LR发生以下错误则可以判断其发生故障:
①数据全零
②数据全为最大量程
③重合点坐标与其它雷达明显抵触
④雷达无响应
⑤雷达产生其它错误
系统所采用的故障自动屏蔽技术,保证了系统工作的连续性,也给系统检 修提供了有利的时间保证。
5.系统结构自动调整
当某些LR因故障被屏蔽后,系统退
化成较低级的扫描系统。这种系统模式 的降级和退化,可能会降低一定的扫描精度,但仍能够保证定位任务不间断的 顺利完成。
随着故障台数的增多,系统自动的逐层降级,可以在拥有最小工作数量LR 的
基础上进行“最小运行模式”,此时系统功能最简化,仍然完成扫描任务;
当某些LR故障被修复后,通过上位程序的确认后,通过重置其状态为“正 常”,重启该LR数据采集线程,可实时升级MLRS拓扑结构;
每当MLRS拓扑结构改变时,系统立即重新根据拓扑结构进化(或退化)系 统模式,自适应地确定合适的坐标匹配与误差补偿算法,并且重新对目标进行 分块,为各个工作LR分配新的扫描区域,在不停止系统运行的情况下实现“即 插即用”。
系统的结构自动调整功能在雷达状态监控模块中实现,主要步骤如下:
1)更新各LR状态,统计当前正常工作的雷达数,以此建立正常LR的句柄 链表;
2)故障后已经修复的LR,重置其状态为“正常”,从故障雷达链表中删除 该雷达句柄,并启动LR采集线程,加入正常雷达链表,重新投入工作;
3)进行故障自动诊断屏蔽处理;
4)根据当前MLRS拓扑结构更新坐标匹配与误差补偿算法;
5)根据当前MLRS拓扑结构重新分配各雷达扫描区域;
6)将当前雷达状态信息反馈给系统状态监控模块,进行显示和报警处理。
本发明提供“吊具-集卡对箱”的多激光雷达协同工作与数据处理方法, 创新性的整合应用了多个先进的数据处理和系统自适应控制技术,大幅的提高 了识别精度和速度,并提供了极强的系统冗余容错能力。满足自动化堆场内RMG 对集卡装卸集装箱的高精度对箱定位要求,有效提高了装卸效率,为检修维护 带来了极大的便利,保证了生产安全连续的进行。
附图说明
图1为本发明方法实现的多激光雷达系统布局示意图(主视图);
图2为本发明方法实现的多激光雷达系统布局示意图(俯视图);
图3为MLRS模块组织结构图;
图4为权值动态分配的误差补偿处理
流程图;
图5为单个雷达数据处理流程图;
图6为故障自动诊断屏蔽工作流程图;
图7为雷达状态监控工作流程图。
具体实施方式
本发明的技术采用多激光雷达系统实现,具体工作流程如下:
1.在系统现场安装阶段,根据现场实测数据训练权值分配网络,建立基于 距离和反射率的初始权值表;
2.MLRS启动时进行状态自检,进行一系列的初始化,对目标进行扫描区域 分块,确定各工作雷达的扫描区域;
3.各个雷达工作子线程独立执行扫描任务,将报文预处理生成测量数据, 并查表插值计算出数据权值,生成扫描数据的置信距离域;
4.MLRS运行中,监控模块实时进行故障自动诊断及屏蔽。根据雷达数据进 行有效性验证,当有雷达发生故障时(数据异常、重合点数据与其它雷达明显 抵触、雷达错误等),立即终止其线程,并且屏蔽其工作;
5.MLRS运行中,监控模块实时监视雷达状态。当有雷达发生故障或者有已 修复的雷达加入工作时,MLRS立即重新根据拓扑结构进化(或退化)系统模式, 自适应地确定合适的坐标匹配与误差补偿算法,并且为各个工作LR分配新的扫 描区域,并反馈结果系统状态显示模块;
6.各个正常雷达独立地同时进行扫描,待所有雷达扫描处理完数据后, MLRS雷达控制与主处理模块进行动态误差补偿处理;
7.MLRS雷达控制与主处理模块根据最终的目标坐标,进行进一步的计算与 辨识处理;根据最后处理结果,发送目标值给控制系统。
以下结合附图和具体工作步骤对本发明的实施方式作进一步详细的说明。
附图中示出了本发明的一种典型实施方式——四激光雷达系统(Quadruple Laser Radar System,以下简称QLRS),该实施方式用于实现一种高低架轨道龙 门起重机装卸工艺中,低架轨道龙门起重机下集卡的对箱定位。
图1为吊具-集卡对箱定位系统构成示意图。如图1所示,1-RMG大车,2-RMG 小车,3-3D激光雷达,4-RMG横梁,5-RMG吊具,6-集装箱,7-集卡对位指示 装置,8-集卡,9-RMG小车运行方向。双向箭头9示出了RMG小车(2)的运行 方向,RMG大车(1)的运行方向与该方向垂直(水平运动)。四个3D激光雷达 (3)均布安装在RMG低架横梁(4)上。
图2为四个3D激光雷达在RMG低架横梁上的安装示意图。如图2所示,1-RMG 大车,2-RMG小车,3-3D激光雷达,4-RMG小车运行方向,5-RMG吊具,6-集 装箱,7-集卡运动方向。四个3D激光雷达(3)沿集装箱对角线方向对称安装 在RMG大车低架横梁(4)上。
图3为多激光雷达系统模块组织结构图,系统主线程生成雷达控制与主处 理模块、雷达状态监控与故障处理模块、系统状态监控模块等。其中雷达控制 与主处理模块为每个雷达生成对应的雷达数据采集子线程和雷达数据处理子线 程。
本发明的技术内容是通过以下具体系统工作流程实现的:
1.为了实现采集数据的动态加权处理,在系统现场安装阶段,根据现场实 测数据训练权值分配网络,建立基于距离和反射率的初始权值表;
2.QLRS启动时进行状态自检,初始化正常雷达链表和故障雷达链表,根 据任务的速度、精度要求,对目标进行扫描区域分块,确定各工作雷达的扫描 区域。QLRS系统分别同步地从就近视点扫描集卡或者
箱体的不同表面,直至有 部分表面重叠,每个LR的扫描区域必须覆盖包含就近
顶点的四分之一的顶面、 可视区域内的两个侧面的近二分之一的面积。重叠部分的多少可以由扫描控制 软件通过设置每一个激光雷达的扫描起始角度来实现,识别出装箱过程集卡的 锁头或卸箱过程箱体锁孔的精确位置。
3.各个雷达子线程根据系统分配的扫描区域,独立执行扫描任务。对于集 卡或集装箱每一个表面的扫描任务可以分解为两类:箱体顶面和四个侧面。对 于顶面的处理方法是:通过集卡的粗定位,使得集卡或集装箱的顶面处于四个 LR的视野之内。每个LR分别从距离自身安装位置最近的顶点逐渐扫过顶面中心 位置,在顶面中心区域各自对其进行不完全扫描,用四个LR采集的数据进行重 叠部分的补偿运算得出比各自扫描精度更高的坐标值。对于侧面的处理方法是: 每个侧面处于两个相邻LR的视野之内。每个LR分别从距离自身安装位置最近 的边逐渐扫过该侧面中心,每两个相邻LR负责对该侧面进行不完全扫描,用相 邻两个LR采集侧面的数据进行重叠部分的补偿运算得出比各自扫描精度更高的 侧面坐标值。各个雷达子线程将报文预处理生成测量数据,并查表插值计算出 数据权值,生成扫描数据的置信距离域;
4.QLRS运行中,监控模块实时进行故障自动诊断屏蔽。监控模块遍历正 常LR链表,对雷达数据进行有效性验证,当有雷达发生故障时(数据异常、重 合点数据与其它雷达明显抵触、雷达错误等),立即终止其线程,并且屏蔽其工 作,将其加入故障LR链表,并在系统状态监控模块显示故障且报警;系统在不 停机的情况下,使用其它LR继续完成扫描任务;
5.QLRS运行中,监控模块实时监视雷达状态。当有雷达发生故障时,QLRS 立即重新根据拓扑结构退化系统模式,随着故障台数的增多,系统自动的逐层 降级,直至拥有2台正常工作LR的“最小运行模式”。当某些LR故障被修复 后,通过上位程序的确认后,通过重置其状态为“正常”,从故障雷达链表中删 除该雷达句柄,并启动LR采集线程,加入正常雷达链表,重新投入工作。随着 系统拓扑结构改变,系统实时自适应地确定合适的坐标匹配与误差补偿算法, 并且为各个工作LR分配新的扫描区域,并将当前雷达状态信息反馈给系统状态 监控模块,进行显示和报警处理。
6.QLRS各个正常雷达独立地同时进行扫描,系统为每个正常LR产生对应 的数据处理子线程,对采集到的距离数据值查询初始权值表,插值计算对应权 值,对于与LR的相对测量距离值较小的、目标反射率较大的目标点测量数据赋 予较大的权值,并且计算出距离置信范围,完成后置位“处理完毕信号量”。待 所有雷达扫描并预处理完数据后,QLRS雷达控制与主处理模块进行动态误差补 偿处理。雷达控制与主处理模块根据当前QLRS系统拓扑结构,采用与当前正常 工作雷达数量(4台、3台或者2台)相对应的坐标匹配算法,进行目标点的拼 接,在重叠区域应用误差补偿算法进行相应的数据处理,计算出补偿后的最终 坐标;
7.QLRS雷达控制与主处理模块根据最终的目标坐标进行进一步的计算与 辨识处理(如计算出集卡后边缘位置,计算吊具姿态,辨识出锁头或锁孔并精 确计算出其位置与尺寸等等);根据最后计算结果,发送目标值给RMG的控制系 统,操控RMG做出相应动作。
所述的四激光雷达系统,采用上述协同工作与数据处理方法,获取集卡相 对与RMG大车和吊具的位置误差(空间三维直角坐标)。在现场测试中,QLRS 控制四个LR的协同工作与数据处理方法,采用相邻LR重叠20%扫描区域,同时 进行分块扫描40英尺集装箱。与采用顺序启动四个LR进行扫描并识别其4个 锁孔位置方式相比,总处理速度约为3倍。与不进行任何重叠扫描及坐标匹配 方式相比,在重叠区域QLRS扫描数据精度提高约35%。四激光雷达协同工作并 可屏蔽故障,当某些激光雷达出现故障时,可以终止故障的激光雷达,由其它 激光雷达进行扫描,虽然扫描精度和速度略有降低,仍能够保证装卸任务的顺 利完成。