一种用于集装箱识别定位的3D数据采集系统及方法技术方案

本发明专利技术公开了一种用于集装箱识别定位的3D数据采集系统及方法，系统包括数据处理器和分别与数据处理器连接的2D激光扫描仪、电机驱动器、惯性器件和交换机。本发明专利技术结构相对简单，且易于实现，同时结合多传感器数据融合技术，对探测目标实现高精度和快速扫描。本发明专利技术以技术成熟的2D激光扫描仪和高精度伺服电机为基础，开发高精度转动云台。在2D激光扫描仪的基础上，增加一个转动轴向的转动量。通过对相关传感器数据的计算得到三维点云数据。本发明专利技术可解决轮胎式集装箱起重机自主识别目标集装箱位置的功能需求；也可解决轮胎式集装箱起重机在作业过程识别箱区轮廓及位置的需求。对提升起重机作业效率和安全性起到关键的作用。

【技术实现步骤摘要】

本专利技术属于物体识别及位置检测技术，具体涉及一种用于集装箱识别定位的3D数据采集系统及方法，应用在集装箱码头的轮胎式集装箱起重机上对集装箱进行三维识别与定位。
技术介绍
当前国内集装箱码头在发展自动化的过程中都遇到需要对堆场中的集装箱进行高精度地识别和定位。而采用2D激光装置和现有的3D激光装置虽然能在一定程度上描绘出扫描面内的箱区轮廓，但是无法实现邻近位置的集装箱位置和姿态信息的检测。在使用2D激光扫描仪进行目标物体识别和位置检测过程中，由于2D激光只能在一个扫描面内实现激光扫描，所以只能对扫描目标物的某一个截面进行检测。而通常情况下，扫描目标物体表面并非规则形状，如果只对某一个截面进行扫描和识别，无法得到完整表面信息。而且现有的3D激光产品都为国外公司生产的利用多线激光或双棱镜反射技术实现的整套性的产品，如果应用这些3D激光产品来对集装箱进行识别和定位，获取的数据稀疏，对目标物体扫描和识别存在较大的误差，无法满足应用的需要。
技术实现思路
为了克服现有技术的上述缺点，本专利技术提供了一种用于集装箱识别定位的3D数据采集系统及方法，利用设置在转动云台上的2D激光扫描仪，并配以多传感器融合算法，持续获取统一坐标系下的三维空间点云数据，进行实时计算从而获取集装箱的三维位置与姿态。本专利技术解决其技术问题所采用的技术方案是：一种用于集装箱识别定位的3D数据采集系统，包括数据处理器和分别与数据处理器连接的2D激光扫描仪、电机驱动器、惯性器件和交换机；所述2D激光扫描仪设置在转动云台上，所述转动云台通过联轴器与伺服电机的减速器连接；所述2D激光扫描仪通过数据线与数据处理器连接，用于将实时扫描的集装箱的二维数据传输给数据处理器，同时按数据处理器发出的控制命令进行扫描；所述数据处理器通过信号线与电机驱动器连接，用于接受数据处理器发出的指令控制伺服电机带动云台在垂直方向上转动；所述惯性器件通过数据线与数据处理器连接，用于将检测到的2D激光扫描仪的位置变化信息和姿态变化信息传送给数据处理器；所述交换机通过数据线与数据处理器连接，用于将数据处理器计算得到的三维点云数据输出给外部设备。本专利技术还提供了一种用于集装箱识别定位的3D数据采集方法，包括如下步骤：步骤一、利用2D激光扫描仪扫描获取点云数据，得到原始3D激光坐标系下的坐标值：设定2D扫描仪的扫描方向为水平方向，转动云台的转动方向为垂直方向；2D激光扫描仪每隔40ms收集一次激光扫描面的扫描信息；伺服电机以匀速带动云台从而带动2D激光扫描仪旋转，在每次收集激光数据的最后一个点的时刻通过读取一次电机编码器数据采集一次云台转动角度信息；步骤二、将原始3D激光坐标系下的坐标值变换到统一的大地坐标系下的坐标值：惯性器件以50Hz的频率向数据处理器发送2D激光扫描仪的位置变化信息和姿态变化信息，确保系统在每一个电机编码器数据刷新周期内获取一次位置变化和姿态变化周期；数据处理器通过具备RTK功能的GPS芯片模块在0.1秒周期后对位置信息进行矫正，获得空间位置相对于原点的变换位移量(Δx，Δy，Δz)和姿态变化角度量(α，β，γ)；然后按如下公式计算三维点云数据(xn，yn，zn)：xn＝(Dln×cosθn+Δx)cosα对于空间坐标系中的某一点n来说，θn为在获取该点数据时刻2D激光扫描仪内部电机相对于0位的转动角度，为在获取该点数据时刻云台的转动角度，Dln为该点的激光扫描仪测量的距离；步骤三、将三维点云数据中n点的位置信息(xn，yn，zn)以PCD文件格式保存并输出给外部设备。与现有技术相比，本专利技术的积极效果是：本专利技术结构相对简单，且易于实现，同时结合多传感器数据融合技术，对探测目标实现高精度扫描。本专利技术以技术成熟的2D激光扫描仪和高精度伺服电机为基础，开发高精度转动云台。在2D激光扫描仪的基础上，增加一个转动轴向的转动量。通过对相关传感器数据的计算得到三维点云数据。本专利技术提供两种扫描方式，一种称为高精度扫描，另一种称为快速扫描。高精度扫描方式可解决轮胎式集装箱起重机自主识别目标集装箱位置的功能需求；快速扫描可解决轮胎式集装箱起重机在作业过程识别箱区轮廓及位置的需求。对提升起重机作业效率和安全性起到关键的作用。附图说明本专利技术将通过例子并参照附图的方式说明，其中：图1是本系统的结构示意图；图2三维激光位移变换坐标示意图；图3三维激光姿态变换坐标示意图。具体实施方式一种用于集装箱识别定位的3D数据采集系统，如图1所示，包括：2D激光扫描仪1、转动云台2、联轴器3、减速器4、伺服电机5、电机驱动器6、数据处理器7、惯性器件8、交换机9、GPS天线10等，其中：所述数据处理器7分别与2D激光扫描仪1、电机驱动器6、惯性器件8、交换机9和GPS天线10连接；其中：所述2D激光扫描仪1设置在转动云台2上，转动云台2通过联轴器3与伺服电机5的减速器4连接；所述2D激光扫描仪1通过数据线与数据处理器7连接，用于将实时扫描的集装箱的二维数据传输给数据处理器7，同时按数据处理器7发出的控制命令进行扫描；所述数据处理器7通过信号线与电机驱动器6连接，用于接受数据处理器发出的指令控制伺服电机带动云台2在垂直方向上转动；所述惯性器件8通过数据线与数据处理器7连接，用于将检测到的3D激光扫描仪设备整体的位置变化信息和姿态变化信息传送给数据处理器7；所述交换机9通过数据线与数据处理器7连接，用于将数据处理器7计算得到的三维点云数据输出给外部设备；所述GPS天线10通过同轴馈线与数据处理器7连接，用于将其接收到的GPS卫星信号传送到数据处理器7中的GPS芯片模块，GPS芯片模块通过计算得出3D激光扫描仪设备的位置信息。该装置的高精度伺服电机通过联动机构带动云台在垂直方向上转动，从而带动安装在云台上的2D激光扫描仪在与云台中轴线垂直的平面内扫描。所述惯性器件包含3轴陀螺和3轴加速度计，其以每秒50hz的频率向数据处理器7发送3D激光扫描仪位置变化信息和姿态变化信息，能保证本系统在每一个电机编码器数据刷新周期内获取一次位置变化和姿态变化周期。本专利技术还提供了一种用于集装箱识别定位的3D数据采集方法，包括如下步骤：步骤一、利用2D激光扫描仪扫描获取点云数据：在本系统中，设定2D扫描仪的扫描方向为水平方向，转动云台的转动方向为垂直方向；2D激光扫描仪以每40ms的时间内收集一次激光扫描面的扫描信息。伺服电机以匀速带动云台从而带动2D激光扫描仪旋转，以每次收集激光数据的最后一个点的时刻读取一次电机编码器数据。同时本专利技术采用了两种扫描方式，其一提供了更高的扫描精度，称之为精确扫描模式；其二提供了更快的扫描速度，称之为快速扫描模式；两种方式分辨满足了在使用中更高精度和更高实时性两种需求。高精度扫描是指在6秒中的周期内，本系统可提供横向190度，纵向10度的扫描视角，并在这个空间内，以横向角度分辨率为最小0.125度和纵向角度分标率最小0.06度，均匀扫描获得不小于17万的点云数据。快速扫描是指在1秒周期内本系统可提供横向190度，纵向50度的扫描视角，并在这个空间内以横向角度分辨率最小0.125度和纵向角度分辨率最小2度，均匀获得不小于3万点的点云数据。在精确扫描模式下，在水平方向上保持2D激光扫描步进0.1667度本文档来自技高网...

【技术保护点】
一种用于集装箱识别定位的3D数据采集系统，其特征在于：包括数据处理器和分别与数据处理器连接的2D激光扫描仪、电机驱动器、惯性器件和交换机；所述2D激光扫描仪设置在转动云台上，所述转动云台通过联轴器与伺服电机的减速器连接；所述2D激光扫描仪通过数据线与数据处理器连接，用于将实时扫描的集装箱的二维数据传输给数据处理器，同时按数据处理器发出的控制命令进行扫描；所述数据处理器通过信号线与电机驱动器连接，用于接受数据处理器发出的指令控制伺服电机带动云台在垂直方向上转动；所述惯性器件通过数据线与数据处理器连接，用于将检测到的2D激光扫描仪的位置变化信息和姿态变化信息传送给数据处理器；所述交换机通过数据线与数据处理器连接，用于将数据处理器计算得到的三维点云数据输出给外部设备。

【技术特征摘要】
1.一种用于集装箱识别定位的3D数据采集系统，其特征在于：包括数据处理器和分别与数据处理器连接的2D激光扫描仪、电机驱动器、惯性器件和交换机；所述2D激光扫描仪设置在转动云台上，所述转动云台通过联轴器与伺服电机的减速器连接；所述2D激光扫描仪通过数据线与数据处理器连接，用于将实时扫描的集装箱的二维数据传输给数据处理器，同时按数据处理器发出的控制命令进行扫描；所述数据处理器通过信号线与电机驱动器连接，用于接受数据处理器发出的指令控制伺服电机带动云台在垂直方向上转动；所述惯性器件通过数据线与数据处理器连接，用于将检测到的2D激光扫描仪的位置变化信息和姿态变化信息传送给数据处理器；所述交换机通过数据线与数据处理器连接，用于将数据处理器计算得到的三维点云数据输出给外部设备。2.根据权利要求1所述的一种用于集装箱识别定位的3D数据采集系统，其特征在于：所述数据处理器通过同轴馈线与GPS天线连接，GPS天线将其接收到的GPS卫星信号传送到数据处理器中的GPS芯片模块，GPS芯片模块对2D激光扫描仪的位置信息进行纠正。3.根据权利要求2所述的一种用于集装箱识别定位的3D数据采集系统，其特征在于：所述GPS芯片模块具备RTK功能。4.根据权利要求1所述的一种用于集装箱识别定位的3D数据采集系统，其特征在于：所述惯性器件包含3轴陀螺和3轴加速度计。5.根据权利要求1所述的一种用于集装箱识别定位的3D数据采集系统，其特征在于：所述惯性器件以每秒50hz的频率向数据处理器发送2D激光扫描仪的位置变化信息和姿态变化信息。6.一种用于集装箱识别定位的3D数据采集方法，其特征在于：包括如下步骤：步骤一、利用2D激光扫描仪扫描获取点云数据，得到原始3D激光坐标系下的坐标值：设定2D扫描仪的扫描方向为水平方向，转动云台的转动方向为垂直方向；2D激光扫描仪每隔40ms收集一次激光扫描面的扫描信息；伺服电机以匀速带动云台从而带动2D激光扫描仪旋转，在每次收集激光数据的最后一个点的时刻通过读取一次电机编码器数据采集一次云台转动角度信息；步骤二、将原始3D激光坐标系下的坐标值变换到统一的大地坐标系下的坐标值：惯性器件以50Hz的频...

【专利技术属性】
技术研发人员：陈福兴，林凡雨，刘旭，刘彦，杨士卫，
申请(专利权)人：北京国泰星云科技有限公司，
类型：发明
国别省市：北京;11