0 引言

在仓储物流配送中,由于货物的数量与种类繁多,工人们花费大宗时间在货仓中取货,并需要使用叉车协助搬运[1,2]。为提高事情效率并节约人力本钱,自主移动机械人与无人叉车已被引入仓储空间,取代人工搬运货物[3]。

为建立系统、科学的仓储物流治理体系,需要对自主移动机械人与无人叉车进行实时、准确的室内定位。现有要领主要有全球定位系统(global positioning system,GPS)、航迹推算定位、声波网络定位与无线射频识别(radio frequency identification,RFID)等[4],划分使用了GPS技术、惯性导航技术、超声技术与无线传感器技术。但以上要领都保存一些缺乏,如GPS的结构规模小、惯性传感器随时间累积误差大、超声受情况影响大、无线射频本钱高等[5,6,7]。

为了在节约人力资源的同时提高物流配送效率,无人叉车在仓储物流中起着要害性作用。实时掌握无人叉车在室内的位置信息,可有效提高控制精度与配送准确度。

本文主要提出了一种基于线性电荷耦合器件(charge coupled device,CCD)图像传感器的室内定位要领。将三轴向CCD传感器与航行时间(time of flight,TOF)深度相机牢固装配在无人叉车上,在室内正上方天花板均匀结构光点并随机点亮,通过检测光线在三轴向CCD组件上的投影偏移;经过物象空间坐标系转换,可解算出叉车在大地全局坐标系下的坐标值。这样就实现了对叉车的实时室内定位,提高了叉车在仓储物流情况下的事情效率。

1 坐标系变换

1971年,Abdel-Aziz等提出了直接线性变换要领(direct linear transform,DLT),通过盘算11个内外方位元素来对CCD成像组件进行校准[8]。1992年,Gazzani提出了只需解算7个系数的要领[8]。吴剑等在此基础上重建了多组一维成像单位的标记点三维坐标[9]。骆文博与王东红平划分在2002年和2006年对DLT要领中的成像进行了成像误差校正[10,11,12]。

本文设计的光学三维投影成像模型由两个相互笔直的一维线阵CCD组件与TOF相机牢固链接,相互笔直组成XYZ三个轴向。CCD组件用于丈量水平面轴向上的偏移量,TOF相机用于丈量竖直偏向上CCD组件平面距离天花板平面的距离。若要实现叉车的室内定位,则需将柱面透镜、线性CCD与TOF等成像组件装载在叉车上,并将天花板平面内点光源在成像组件上形成的交点成像位置视为叉车的坐标点。

CCD光学三维投影成像模型如图1所示。

图1 光学三维投影成像模型Fig.1 Optical 3D projection model 

为便当示意,图1中只显示了水平面y轴偏向上的投影成像原理。在各个CCD传感器前笔直安排一面定焦距柱形光学镜片。由光学特性可知,当点光源到柱面镜光心点的物距远远大于透镜焦距时,空间中的任意一点光源通过柱形光学镜投影到CCD平面,会形成与线性CCD线列笔直的直线光列。该光列与线性CCD会相交于直线上的某一点。图1中:OXYZ为三维大地坐标系;O'X'Y'Z'为三维柱面镜坐标系;o4x4y4z4为辅助坐标系;O'wX'wY'wZ'w为旋转平移坐标系,用于大地坐标系与三维柱面镜坐标系之间的变换。点A是室内天花板平面内一随机光点,在大地坐标系下的坐标值为(X,Y,Z)。

TOF相机在大地坐标系X下的测距示意图如图2所示。

图2 TOF相机测距示意图Fig.2 Schematic diagram of TOF camere ranging   

在与叉车固连的光学组件中,线性CCD传感器与柱面透镜配合组成了水平面,而TOF相机测距则为竖直偏向。因此,由于室内情况的竖直高度牢固,当叉车水平地面移动时,TOF深度相机可直接测得其在大地坐标系竖直X轴上的坐标值为:

式中:H为地面到天花板平面的竖直距离;X'w为利用TOF深度相机在竖直向上偏向的丈量值。

本文主要以点光源A在线性CCD组件y轴偏向上的光学成像为例。以柱形透镜的中心点为原点O',笔直向上偏向为X'轴,指向线性CCD偏向为Z'轴,与X'Y'平面笔直的偏向为Y'轴。同时,在线阵CCD上建立一维像坐标系(1),以线阵CCD中点O1为原点,与Y'轴平行但偏向相反的y轴。点光源A在经过光面镜投影后形成的平行直线与线阵CCD交于点y1,透镜光轴与线阵CCD交于点y0,距离约为焦距f。点y0与y1之间的距离Δy就是点光源A投影在线阵CCD的y轴偏向上的偏移量。

1.1 从大地坐标系到柱面镜坐标系的坐标系变换

记点光源A在大地坐标系下的坐标为(X,Y,Z),若要将三维大地坐标系转换到三维柱面镜坐标系,只需进行一次坐标系的旋转宁静移。在旋转矩阵R'宁静移矩阵T'的辅助下,可获得点光源A在三维柱面镜坐标系(1)下的坐标(X',Y',Z'):

1.2 从大地坐标系到像点坐标系的坐标系变换

由于像点坐标系是一维矩阵,所以无法通过坐标系之间的旋转与平移直接获得,而需要进行间接转换。设镜头没有畸变,f为镜片焦距,凭据针孔成像原理可获得理想的成像模型,投影关系为:

式中:L'1～L'7为7个坐标转换系数。

1.3 L系数、R矩阵、T矩阵盘算

当大地坐标系变换到像点坐标系(1)后,取n(n≥7)组点光源坐标与其对应的像点坐标,利用最小二乘法即可解算出7个变换系数L'1～L'7:

凭据7个L'系数和式(5),即可求解出旋转矩阵R'的9个参数R'。由于旋转阵R'为正交矩阵,各行各列两两正交且都为单位向量,由此可得。将Z'w代入式(4)中,划分求解出r'31、r'32、r'33的表达式为:

在此基础上求解出各个L系数的值,并可获得y轴偏向上的偏移量:

联立方程式,求得r'21、r'22、r'23宁静移矩阵T'中的参数Y'w的表达式如下:

在三轴向CCD的同一水平面固链TOF相机。由于所有点光源都牢固在室内天花板上,可视其在X轴偏向上的数值牢固。利用TOF相机直接测出CCD组件在竖直偏向上与天花板的距离值,即为平移矩阵T'的x'w分量。

由此,已解算出从大地坐标系转换到三维柱面镜坐标系(1)时,旋转矩阵R'的9个旋转系数宁静移矩阵T'的3个分量。若已知其中某一坐标系的坐标值,就可在两个坐标系之间进行转换。

1.4 叉车的大地坐标系盘算

由于TOF相机可直接测出叉车在大地坐标系X轴向上的坐标,不需要在该偏向进行坐标变换息争算,因此在本节中只考虑大地水平面Y和Z轴偏向上的变换。已知从大地坐标系到三维柱面镜坐标系(1)的转换关系,利用矩阵求逆,可以反推出从柱面镜坐标系(1)到大地坐标系的盘算方程,具体表达式如下:

当空间内三坐标系之间的关系确准时,本文将一个光点在CCD上的成像位置视为叉车的坐标点。只要测出叉车上CCD组件的偏移量Δx和Δy,便可获得辅助坐标系o4x4y4z4上像点的坐标值(0,Δy,Δx)(凭据x4、y4、z4轴顺序)。又由于柱面镜与CCD组件为牢固链接,可直接推算出像点在三维柱面镜坐标系(1)下的坐标值(0,-Δy,f+Δx)(凭据X'、Y'、Z'轴顺序)。再将该坐标值代入式(10),进行柱面镜坐标系与大地坐标系之间的变换,加上TOF测得的大地X轴坐标,所得即为叉车在大地坐标系下的准确位置。

2 仿真试验

在室内天花板上取7个随机点光源,利用三坐标激光跟踪仪测得它们的坐标值。其中,天花板高度为3 m,所以它们在x轴向上的坐标值为3 000 mm。同时,给定对应的7个像点的三轴向坐标值,设定柱面镜的定焦距为50 mm。在Matlab运行本文的算法进行仿真试验。

7个点光源(A点)在大地坐标系和其投影在三个一维像坐标系O2x、O1y、O3z下的坐标值如表1所示。

表1 点光源在差别坐标系下的坐标值Tab.1 Coordinate values of points source in different coordinate systems 

像点在差别坐标系下的位置漫衍如图3所示。

图3 像点在差别坐标系下的位置漫衍Fig.3 The positional distribution of points in the different coordinate system  

图3(a)和图3(b)划分展示了7个预先点光源(玄色实点)和1个测试光点(白色空心点)在大地坐标系及其投影在CCD组件所在的三个一维像坐标系下的位置漫衍。

利用上文所述最小二乘法,可对坐标系变换中的L系数进行解算。从大地坐标系转换到三维柱面镜坐标系(1)时的L'系数为:L'1=-0.301、L'2=0.037、L'3=-0.161、L'4=229.103、L'5=6.939e-18、L'6=-6.592e-16、L'7=-3.333e-4。

利用L'系数,可解算出光轴线与像坐标系x轴与y轴的交点位置y0=484.993 mm。同时,也可解算出坐标系转换中的旋转矩阵R'宁静移矩阵T',划分为:

最终可得出从三维柱面镜坐标系(1)转换回大地坐标系的变换关系为:

将像点在柱面镜坐标系下的坐标代入式(13),即可得出最终7组叉车在大地坐标系XYZ下的位置,以及其在三维柱面镜坐标系(1)O'X'Y'Z'下的坐标。叉车像点在差别坐标系下的坐标值如表2所示。

表2 叉车像点在差别坐标系下的坐标值Tab.2 Coordinate values of picpointed points in different coordinate system  

在建立与解算7组成像模型的基础上,空间内三个坐标系的关系已确定。随机取天花板平面内一测试光点B,它在大地坐标系下的坐标为(3000.000,2736.000,3239.000),在三轴向CCD组件上的投影坐标为(0,-3.273,52.826)(凭据X'轴、Y'轴、Z'轴顺序)。代入式(22)后可解算出其在大地坐标系下的位置为(1000.000,2947.173,5707.520),即为此时叉车在大地坐标系下的位置。像点在大地坐标系下的位置漫衍如图4所示。

图4 像点在大地坐标系下的位置漫衍Fig.4 Positional distribution of points in the geodetic coordinate systems   

图4中,8组像点在大地坐标系下的三维漫衍。其中,玄色实心球代表7组事先测定的点光源在叉车CCD组件上的投影点,空心球代表测试光点B的投影成像点。

3 结束语

综上所述,对本文所提出的要领进行仿真,验证了要领的可行性和准确性。当室内牢固点光源发光,利用事先收罗好的至少7组大地坐标值和像点坐标值,在光学成像基础上,快速、准确土地算出像点坐标系与大地坐标系之间的变换方程(包括旋转矩阵宁静移矩阵的各个分量)。此时,只要随机点亮室内天花板上某一点光源,测得光点在三轴向CCD组件上的投影偏移,即可推算出叉车像点在大地坐标系下的准确位置。在仓储物流情况中,有效、实时地定位无人叉车在室内的精准位置,将有助于提高物流配送与控制效率,对物流工业有极大的增进作用。