[发明专利]基于结构光视觉传感器的集装箱位置姿态测量方法

说明书

技术领域

本发明涉及摄像测量、机械自动化领域，特别是一种利用结构光视觉传感器实现集装箱吊装过程中吊具与集装箱相对位置姿态的测量方法。

技术背景

在集装箱的移动运输过程中，需要利用吊具进行集装箱的吊装作业。目前吊装作业均由人工操作，对操作人员技术及经验要求较高，特别是吊具的对销过程需将转锁连接集装箱的角件，作业难度较高，作业效率较低。为了提高集装箱移动、运输的作业效率，降低工作人员的劳动强度，促进吊装作业的自动化水平，需要自动测量集装箱相对吊具的位置姿态关系，进而实现吊具的自动控制。

本发明提出了一种基于结构光视觉传感器的集装箱位置姿态测量方法，用于吊装作业中集装箱相对吊具的位置、姿态关系的测量，为吊装自动控制提供测量信息。本发明的原理和方法也可应用于其他物体的位置姿态测量场合。

发明内容

本发明是：在集装箱吊装设备(正面吊、堆高机或门式起重机等)的吊具上安装能够敏感集装箱边缘和/或角孔信息的结构光视觉传感器，该传感器包含一个或多个结构光投射器（点阵、线阵、网格结构光或其组合等）、一个或多个摄像机和数据处理器，吊装过程中，结构光视觉传感器向集装箱表面投射结构光，同时拍摄图像，通过处理图像获取集装箱边缘、角孔和/或顶点结构特征，测量结构特征的坐标，进而计算集装箱相对吊具的位置、姿态关系。

1 本发明的基于结构光视觉传感器的集装箱位置姿态测量方法的实施过程为：

（1）构建能够敏感集装箱边缘和/或角孔信息的结构光视觉传感器，包含一个或多个结构光投射器（点阵、线阵、网格结构光或其组合等）、一个或多个摄像机、数据处理器等。将结构光视觉传感器安装在吊具上，使吊装过程中可对集装箱表面投射结构光并成像； 

（2）标定结构光视觉传感器与吊具的相对位置姿态关系，如附图2所示；

（3）吊装过程中结构光视觉传感器向集装箱表面投射结构光并拍摄图像； 

（4）处理图像，利用结构光的点、线、面等信息获取集装箱几何结构特征（如集装箱的边缘、顶点、角孔等）；

（5）根据集装箱结构特征的图像坐标，计算其在结构光视觉传感器坐标系的坐标方程表示，并转换到吊具坐标系；

（6）根据集装箱结构特征的测量结果计算集装箱相对吊具的位置、姿态关系，用于吊装控制。

2 本发明的基于结构光视觉传感器的集装箱位置姿态测量方法

（1）集装箱结构特征坐标方程计算方法

处理图像，提取集装箱的结构特征的图像坐标方程，根据摄像测量原理建立结构特征在结构光视觉传感器坐标系内的表示。设去除像差后集装箱某特征点图像坐标为（x_i,y_i），则其坐标(X_i,Y_i,Z_i)满足共线方程