自动导引车的多目视觉导引驱动装置及其协同标定方法
【专利摘要】本发明提供了一种自动导引车的多目视觉导引驱动装置及其协同标定方法，所述的自动导引车车体固定联接有若干导引驱动装置，每个导引驱动装置包括减震单元、驱动单元和视觉单元。每个视觉单元具有一台摄像机，多个导引驱动装置上的摄像机组成了自动导引车的多目视觉系统。本发明利用单个导引驱动装置可绕空心短轴旋转的结构特点，通过静态标定和动态标定的方法，联合确立了景物坐标系与每个导引驱动装置运动控制坐标系及其与车体运动间的位姿关系，有效消除了视觉成像的畸变失真、比例失真、倾斜失真及多台摄像机的安装位姿误差。该方法可用于自动导引车基于平面矢量图的多目视觉精确测量，无需使用精密测量仪器，具有操作性好和柔性高的特点。
【专利说明】自动导引车的多目视觉导引驱动装置及其协同标定方法【技术领域】
[0001]本发明涉及计算机视觉检测领域，具体是一种自动导引车的多目视觉导引驱动装置及其协同标定方法。
【背景技术】
[0002]自动导引车(automated guided vehicle, AGV)是一种轮式移动机器人,广泛用于工厂自动化生 产线、仓储物流、机场和港口中的物料传送。其导引方式是自动导引车实现自动输送的核心技术之一，不仅决定了由其组成的自动化输送系统的柔性，也影响到系统运行的可靠性和组态费用。多目视觉导引方式是通过安装在每个导引驱动装置上的摄像机组成自动导引车的多目视觉系统，利用该系统采集地面上铺设的导引路径的图像，通过计算机视觉检测技术实时测量AGV相对导引路径的距离偏差和角度偏差。
[0003]在自动导引车多目视觉系统检测导引路径的过程中，为了获取空间点与摄像机采集的像素点之间的对应关系，摄像机的标定必不可少。该过程主要获取摄像机内部的几何和光学特性，即内部参数，以及摄像机坐标系相对于空间坐标系的位姿关系，即外部参数。此外，在实际成像过程中，摄像机透镜的形状使得空间直线成像后并非理想直线，从而影响控制精度，因此也需对其进行校正。
[0004]摄像机标定主要有传统标定法、主动视觉标定法和自标定法。传统的摄像机标定是将精密制作的立体或平面标靶放置在场景中，通过几何成像原理，建立场景中景物点与图像中观测点之间的关系模型，采用线性或非线性法计算摄像机的内部参数、外部参数和崎变参数，具有标定精度闻的特点。基于主动视觉的标定方法需要控制摄像机做特定运动，如相互正交的平动和绕光轴的旋转运动等，利用参考点的图像坐标变化，实现摄像机的内部参数标定。该方法对摄像机的运动精度要求苛刻，主要用于工业机器人手眼标定，不适用于摄像机运动自由度受限的场合。
[0005]在自动导引车的导引驱动装置中，摄像机与驱动单元的相对位置不变，摄像机内、外部参数和畸变参数均不变。传统标定方法虽然可以获得摄像机的外部参数，但是该参数只是标靶坐标系与摄像机坐标系之间的位姿关系。在自动导引车的视觉导引应用中，还需要获得摄像机坐标系与整车运动控制坐标系之间的位姿关系，在不借助其他精密测量仪器的情况下，很难将标靶相对于整车运动控制坐标系精确地放置。
【发明内容】
[0006]本发明的目的在于提供一种自动导引车的多目视觉导引驱动装置及其协同标定方法，有效消除了视觉成像的畸变失真、比例失真、倾斜失真及多台摄像机的安装位姿误差，可用于自动导引车基于平面矢量图的多目视觉精确测量，无需使用精密测量仪器，具有操作性好和柔性高的特点。
[0007]本发明所述的自动导引车车体固定连接有若干导引驱动装置，每个导引驱动装置包括减震单元、驱动单元和视觉单元，其中，减震单元通过固定板与车体连接；驱动单元包括空心短轴、底盘和电驱动轮，空心短轴与减震单元通过深沟球轴承同轴装配，底盘装在空心短轴底部，两电驱动轮沿底盘中心轴对称布置；视觉单元包括摄像机和LED辅助光源，摄像机垂直向下安装在两电驱动轮的中心线上方，通过紧固架固定在支撑架上，支撑架与空心短轴同轴联接；角度传感器转子固定在悬架的末端，外壳与摄像机壳体固联；多个导引驱动装置上的视觉单元组成了自动导引车的多目视觉系统。
[0008]进一步改进,所述的减震单元包括减震单元顶层、减震单元底层以及它们之间同轴对称的布置四个减震弹簧。
[0009]进一步改进，所述的深沟球轴承通过套筒与空心短轴定位。
[0010]进一步改进，所述的减震单元与驱动单元之间的相对转角由机械限位开关确定。
[0011]进一步改进，所述的视觉单元包括LED辅助光源及摄像机。
[0012]本发明还提供了一种所述的多目视觉导引驱动装置的协同标定方法，包括以下步骤:
[0013]I)通过静态标定获得摄像机的内部参数、外部参数,确立景物坐标系与每个摄像机坐标系之间的位姿关系；
[0014]2)根据导引驱动装置可绕空心短轴自由旋转的结构特点，采用角度传感器精确测量驱动单元的旋转角度，采用机械限位开关精确调节驱动单元的旋转位置。控制自动导引车做特定运动，通过动态标定获得摄像机坐标系与对应导引驱动装置运动控制坐标系的位姿关系及任意导引驱动装置之间的位置关系；
[0015]3)通过坐标变换联合确立景物坐标系与每个导引驱动装置运动控制坐标系乃至整车运动控制坐标系之间的位姿关系。
[0016]进一步改进，所述的静态标定方法具体包括以下步骤:
[0017]I)静止状态下，利用单台摄像机Ci获取M张位于三维空间中的平面模板的不同位姿图像，所述平面模板上分布有N个精确的特征点；
[0018]2)获取所述平面模板图像上全部特征点的坐标值；
[0019]3)利用不考虑摄像机径向畸变的线性模型，估计出摄像机内部参数和外部参数的初值；
[0020]4)利用采集的M张平面模板的图像，采用最大似然估计法计算非线性模型下摄像机内部参数、外部参数和畸变参数的精确解；其中，所述内部参数包括(Kx, ^和(uQ,v0) i； (Kx, Ipi为成像平面到图像平面在X轴和Y轴方向的放大系数，(Utl, %\为光轴中心线在成像平面的交点的图像坐标；外部参数是景物坐标系在摄像机坐标中的描述，包括
(η, O, a, ，其中宙为景物坐标系OwXwYwZw中Xw轴在摄像机坐标系OciXciYciZci的方向向量；ο为景物坐标系OwXwYwZw中Yw轴在摄像机坐标系ocixciYcizci的方向向量；i为景物坐标系
OwXwYwZw中Zw轴在摄像机坐标系OciXciYciZci的方向向量；I为景物坐标系OwXwYwZw的坐标原
点在摄像机坐标系OeiXeiYeiZcii中的位置；畸变参数包括(k1; k2)i,对于摄像机畸变,其主要部分为由于摄像机透镜形状产生的径向畸变。
[0021]进一步改进,所述的动态标定方法具体包括以下步骤:
[0022]I)分别控制自动导引车的每个导引驱动装置绕其运动控制中心点Oki自转，对应的摄像机Ci分别采集地面两个特征点在自转状态下的连续时间序列视频；[0023]2)采集的特征点在图像序列中的轨迹为两段同心圆弧，采用最小二乘法拟合圆弧。分别计算拟合圆弧的圆心在每台摄像机的图像坐标系中的坐标，所述圆心坐标即为导引驱动装置运动控制中心点Oki的图像坐标，亦为导引驱动装置运动控制坐标系OkiXkiYkiZki与摄像机坐标系OcdXcdYcdZcd之间的位置偏差(tx，ty)i在图像中的表示；
[0024] 3)控制每个导引驱动装置自转至角度传感器的示值为零的位置，通过机械限位开关将导引驱动装置与车体的相对位置固定，即所有导引驱动装置定位在与自动导引车前进方向平行的位置；控制自动导引车作匀速直线运动，每台摄像机分别采集地面上的同一特征点在匀速直线运动状态下的连续时间序列视频；采集的特征点在图像序列中的坐标呈线性分布，采用最小二乘法拟合直线，分别计算拟合直线与每台摄像机图像坐标系水平轴的夹角-1-，所述夹角即为摄像机坐标系与对应导引驱动装置运动控制坐标系之间的旋转角；
[0025]4)得到旋转角-?之后，通过坐标变换即可得特征点在运动控制坐标系中的轨迹，该轨迹应为对应导引驱动装置数量的平行直线；任意两直线m、η间的距离为两导引驱动装置运动控制中心点在垂直于自动导引车前进方向上的距离偏差Λχπ_η ；
[0026]5)控制导引驱动装置自转至角度传感器的示值为90°的位置，通过机械限位开关将导引驱动装置与车体的相对位置固定，即所有导引驱动装置定位在与自动导引车前进方向垂直的位置，控制自动导引车作侧向平移运动；在地面上布置特征点Pi,所述特征点位于同一条直线上，且每个特征点位于对应导引驱动装置摄像机的视野范围之内，特征点个数对应导引驱动装置个数，特征点间的距离由制作标定模板时精确测定，同时尽量保证特征点所在直线与自动导引车前进方向平行；分别采集匕在对应摄像机中的连续时间序列视频，Pi的轨迹为直线，采用最小二乘法拟合直线，计算两导引驱动装置m、η运动控制中心点
在自动导引车前进方向上的距离偏差Aynra;由于导引驱动装置之间的姿态偏差禱在自动
导引车运行过程中可控，从而确定导引驱动装置运动控制坐标系之间的位姿关系；
[0027]6)通过坐标变换可得任意两导引驱动装置运动控制坐标系OkiXkiYkiZki与OkjXkjYkjZkj之间的位姿关系；以任一导引驱动装置运动控制坐标系为参照，即可建立整个自动导引车的整车运动控制坐标系。
[0028]本发明的有益效果在于:导引驱动装置可绕空心短轴自由旋转，通过角度传感器实现对旋转角度的精确度量，通过机械限位开关实现对旋转位置的精确定位。一次安装后，每台摄像机的内部参数、外部参数均不再发生改变，利用静态标定和动态标定相结合的协同标定方法，联合确立了景物坐标系与每个导引驱动装置运动控制坐标系乃至整车运动控制坐标系之间的位姿关系，有效消除了视觉成像的畸变失真、比例失真、倾斜失真及多台摄像机的安装位姿误差。经过本发明协同标定的多目视觉系统，可用于自动导引车基于平面矢量图的多目视觉精确测量。该方法在现场实施的过程中无需使用精密测量仪器，具有操作性好和柔性高的特点。
【专利附图】
【附图说明】
[0029]图1为本发明所述的视觉导引驱动装置的结构示意图；
[0030]图2为本发明所述的多个视觉导引驱动装置组成自动导引车的布局示意图；
[0031]图3为本发明所述的多目视觉系统协同标定方法实施例的流程示意图；[0032]图4为本发明所述的静态标定方法中单台摄像机实际成像模型的示意图；
[0033]图5为本发明所述的静态标定方法中平面模板的示意图；
[0034]图6为本发明所述的静态标定方法中16张不同位姿的平面模板在摄像机坐标系中的位姿示意图；
[0035]图7为本发明所述的动态标定方法中导引驱动装置在自转状态下，两个特征点相对导引驱动装置视觉单元的运动轨迹示意图；
[0036]图8为本发明所述的动态标定方法中自动导引车做前向直行运动时导引驱动装置的布局示意图；
[0037]图9为本发明所述的动态标定方法中自动导引车做前向直行运动时特征点的运动轨迹示意图；
[0038]图10为本发明所述的动态标定方法中自动导引车做侧向平移运动时导引驱动装置的布局示意图。
[0039]图中标号名称:1、深沟球轴承；2、减震单兀底层；3、减震弹黃；4、减震单兀顶层；
5、固定板；6、悬架；7、支撑架；8、LED辅助光源；9、角度传感器；10、摄像机；11、紧固架；12、空心短轴；13、套筒；14、机械限位开关；15、底盘；16、电驱动轮；17、万向轮；18、人工特征点；19、摄像机坐标系；20、导引驱动装置运动控制坐标系；21、视觉单元视野范围。
【具体实施方式】
[0040]下面结合附图对本发明做进一步说明。
[0041]本发明提供的视觉导引驱动装置的结构如图1所示。该视觉导引驱动装置通过固定板(5)固定联接于自动导引车车体，每个装置包括减震单元、驱动单元和视觉单元，多个导引驱动装置上的视觉单元组成了自动导引车的多目视觉系统。
[0042]减震单元顶层(4 )与减震单元底层(2 )之间同轴对称布置4个减震弹簧(3 )，减震单元顶层(4)与固定板(5)同轴焊接。所述的驱动单元包括空心短轴(12)、底盘(15)和电驱动轮(16)，空心短轴(12)与减震单元底层(2)通过深沟球轴承(I)同轴装配，减震单元与驱动单元之间的相对转角由机械限位开关(14)确定。所述的深沟球轴承(I)通过套筒
(13)与空心短轴(12)定位。底盘(15)装在空心短轴(12)底部，两电驱动轮(16)沿底盘
(15)中心轴对称布置。所述的视觉单元包括LED辅助光源(8)及摄像机(10)，摄像机(10)垂直向下安装在两电驱动轮(16)的中心线上方，通过紧固架(11)固定在支撑架(7)上，支撑架(7)与空心短轴(12)同轴联接；角度传感器(9)转子固定在悬架(6)的末端，外壳与摄像机(10)壳体固联。
[0043]图2为本发明所述的多个视觉导引驱动装置组成自动导引车的布局示意图，包括万向轮(17 )、人工特征点(18 )、摄像机坐标系(19 )、导引驱动装置运动控制坐标系(20 )、视觉单元视野范围(21)。通过在车体周围设置万向轮(17)减少导引驱动装置上所受的载荷，实现载荷的均匀分布。人工特征点(18)为两条不同颜色的色带的交点。为了便于自动导引车系统模型的说明，假设以Y方向作为自动导引车的前进方向，并将摄像机坐标系与导引驱动装置运动控制坐标系之间的位姿偏差及视野范围进行一定比例的缩放如(19)、(20)及(21)所示。
[0044]图3为本发明所述的多目视觉系统协同标定方法实施例的流程示意图。首先通过静态标定获得摄像机的内部参数、外部参数，确立景物坐标系与每个摄像机坐标系间的位姿关系，具体包括以下步骤:[0045]I)静止状态下，利用单台摄像机Ci获取M张位于三维空间中的平面模板的不同位姿图像，所述平面模板上分布有N个精确的特征点；
[0046]2)获取所述平面模板图像上全部特征点的坐标值；
[0047]3)利用不考虑摄像机径向畸变的线性模型，估计出摄像机内部参数和外部参数的初值；
[0048]4)利用采集的M张平面模板的图像，采用最大似然估计法计算非线性模型下摄像机内部参数、外部参数和畸变参数的精确解；其中，所述内部参数包括(Kx, ^和(uQ,v0) i； (Kx, Ipi为成像平面到图像平面在X轴和Y轴方向的放大系数，(Utl, %\为光轴中心线在成像平面的交点的图像坐标；外部参数是景物坐标系在摄像机坐标中的描述，包括
泛),，其中g为景物坐标系OwXwYwZw中Xw轴在摄像机坐标系AcAiYcdZcd的方向向量;5为景物坐标系OwXwYwZw中Yw轴在摄像机坐标系OciXciYciZci的方向向量；赢为景物坐标
系OwXwYwZw中Zw轴在摄像机坐标系OciXciYciZci的方向向量；P为景物坐标系OwXwYwZw的坐标
原点在摄像机坐标系OeiXeiYciiZcii中的位置；畸变参数包括(Iipk2)i对于摄像机畸变,其主要部分为由于摄像机透镜形状产生的径向畸变。
[0049]然后控制自动导引车做特定运动，获得摄像机坐标系与对应导引驱动装置运动控制坐标系之间的位姿关系及任意导引驱动装置之间的位置关系，具体包括以下步骤:
[0050]I)分别控制自动导引车的每个导引驱动装置绕其运动控制中心点Oki自转，对应的摄像机Ci分别采集地面两个特征点在自转状态下的连续时间序列视频；
[0051]2)采集的特征点在图像序列中的轨迹为两段同心圆弧，采用最小二乘法拟合圆弧。分别计算拟合圆弧的圆心在每台摄像机的图像坐标系中的坐标，所述圆心坐标即为导引驱动装置运动控制中心点Oki的图像坐标，亦为导引驱动装置运动控制坐标系OkiXkiYkiZki与摄像机坐标系OcdXcdYcdZcd之间的位置偏差(tx，ty)i在图像中的表示；
[0052]3)控制每个导引驱动装置自转至角度传感器的示值为零的位置，通过机械限位开关将导引驱动装置与车体的相对位置固定，即所有导引驱动装置定位在与自动导引车前进方向平行的位置；控制自动导引车作匀速直线运动，每台摄像机分别采集地面上的同一特征点在匀速直线运动状态下的连续时间序列视频；采集的特征点在图像序列中的坐标呈线性分布，采用最小二乘法拟合直线，分别计算拟合直线与每台摄像机图像坐标系水平轴的夹角供》?，所述夹角即为摄像机坐标系与对应导引驱动装置运动控制坐标系之间的旋转角；
[0053]4)得到旋转角之后，通过坐标变换即可得特征点在运动控制坐标系中的轨迹，该轨迹应为对应导引驱动装置数量的平行直线；任意两直线m、η间的距离为两导引驱动装置运动控制中心点在垂直于自动导引车前进方向上的距离偏差Λχπ_η ；
[0054]5)控制导引驱动装置自转至角度传感器的示值为90°的位置，通过机械限位开关将导引驱动装置与车体的相对位置固定，即所有导引驱动装置定位在与自动导引车前进方向垂直的位置，控制自动导引车作侧向平移运动；在地面上布置特征点Pi,所述特征点位于同一条直线上，且每个特征点位于对应导引驱动装置摄像机的视野范围之内，特征点个数对应导引驱动装置个数，特征点间的距离由制作标定模板时精确测定，同时尽量保证特征点所在直线与自动导引车前进方向平行；分别采集匕在对应摄像机中的连续时间序列视频，Pi的轨迹为直线，采用最小二乘法拟合直线，计算两导引驱动装置m、η运动控制中心点在自动导引车前进方向上的距离偏差Aym_n。
[0055]最后，结合导引驱动装置可绕空心短轴旋转的结构特点，即任意导引驱动装置之间的角度偏差可控，建立自动导引车的整车运动控制坐标系。
[0056]图4为本发明所述的静态标定方法中单台摄像机实际成像模型的示意图。其中在摄像机坐标系中深度为I的成像平面为图像平面归一化后的等效平面。深度为tzg的成像平面为理想景物点在摄像机坐标系中的成像平面，即为平面模板坐标系，OwXwYwZw为景物坐标系。对于任一摄像机，设摄像机坐标系为OcdXcdYcdZcd，图像坐标系为(u，v)i。根据理想透视模型有
【权利要求】
1.一种自动导引车的多目视觉导引驱动装置，其特征在于:自动导引车车体固定连接有若干导引驱动装置，每个导引驱动装置包括减震单元、驱动单元和视觉单元，其中，减震单元通过固定板(5)与车体连接；驱动单元包括空心短轴(12)、底盘(15)和电驱动轮(16)，空心短轴(12)与减震单元通过深沟球轴承(I)同轴装配，底盘(15)装在空心短轴(12)底部，两电驱动轮(16 )沿底盘(15 )中心轴对称布置；视觉单元包括LED辅助光源(8 )和摄像机(10)，摄像机(10)垂直向下安装在两电驱动轮(16)的中心线上方，通过紧固架(11)固定在支撑架(7 )上，支撑架(7 )与空心短轴(12 )同轴联接；角度传感器(9 )转子固定在悬架(6)的末端，外壳与摄像机(10)的壳体固联；多个导引驱动装置上的视觉单元组成了自动导引车的多目视觉系统。
2.根据权利要求1所述的导引驱动装置，其特征在于:所述的减震单元包括减震单元顶层(4)、减震单元底层(2)以及它们之间同轴对称布置的四个减震弹簧(3)。
3.根据权利要求1所述的导引驱动装置，其特征在于:所述的深沟球轴承(I)通过套筒(13)与空心短轴(12)定位。
4.根据权利要求1所述的导引驱动装置，其特征在于:所述的减震单元与驱动单元之间的相对转角由机械限位开关(14)确定。
5.根据权利要求1所述的导引驱动装置，其特征在于:所述的视觉单元包括LED辅助光源(8)及摄像机(10)。
6.一种以上任意一项权利要求所述的多目视觉导引驱动装置的协同标定方法，其特征在于包括以下步骤: 1)通过静态标定获得摄像`机的内部参数、外部参数，确立景物坐标系与每个摄像机坐标系之间的位姿关系； 2)根据导引驱动装置可绕空心短轴自由旋转的结构特点，采用角度传感器精确测量驱动单元的旋转角度，采用机械限位开关精确调节驱动单元的旋转位置，控制自动导引车做特定运动，通过动态标定获得摄像机坐标系与对应导引驱动装置运动控制坐标系的位姿关系及任意导引驱动装置之间的位置关系； 3)通过坐标变换联合确立景物坐标系与每个导引驱动装置运动控制坐标系乃至整车运动控制坐标系之间的位姿关系。
7.根据权利要求6所述的多目视觉导引驱动装置的协同标定方法，其特征在于，所述的静态标定方法具体包括以下步骤: 1)静止状态下，利用单台摄像机Ci获取M张位于三维空间中的平面模板的不同位姿图像，所述平面模板上分布有N个精确的特征点； 2)获取所述平面模板图像上全部特征点的坐标值； 3)利用不考虑摄像机径向畸变的线性模型，估计出摄像机内部参数和外部参数的初值； 4)利用采集的M张平面模板的图像，采用最大似然估计法计算非线性模型下摄像机内部参数、外部参数和畸变参数的精确解；其中，所述内部参数包括(Kx，Ky)jP (Uci, V0)i，(H)i为成像平面到图像平面在X轴和Y轴方向的放大系数，(U(l，Vt^i为光轴中心线在成像平面的交点的图像坐标；外部参数是景物坐标系在摄像机坐标中的描述，包括in, Of d,#)i,其中芄为景物坐标系OwXwYwZw中Xw轴在摄像机坐标系OciXciYciZci的方向向量；5为景物坐标系OwXwYwZw中Yw轴在摄像机坐标系ocixciYcizci的方向向量；￡为景物坐标系OwXwYwZw中Zw轴在摄像机坐标系OciXciYciZci的方向向量；#为景物坐标系OwXwYwZw的坐标原点在摄像机坐标系OeiXeiYciiZcii中的位置；畸变参数包括(I^k2)i,对于摄像机畸变,其主要部分为由于摄像机透镜形状产生的径向畸变。
8.根据权利要求6所述的多目视觉导引驱动装置的协同标定方法，其特征在于，所述的动态标定方法具体包括以下步骤: 1)分别控制自动导引车的每个导引驱动装置绕其运动控制中心点Oki自转，对应的摄像机Ci分别采集地面两个特征点在目转状态下的连续时间序列视频； 2)采集的特征点在图像序列中的轨迹为两段同心圆弧，采用最小二乘法拟合圆弧，分别计算拟合圆弧的圆心在每台摄像机的图像坐标系中的坐标，所述圆心坐标即为导引驱动装置运动控制中心点Oki的图像坐标，亦为导引驱动装置运动控制坐标系OkiXkiYkiZki与摄像机坐标系OcdXcdYcdZcd之间的位置偏差(tx，ty)i在图像中的表示；
3)控制每个导引驱动装置自转至角度传感器的示值为零的位置，通过机械限位开关将导引驱动装置与车体的相对位置固定，即所有导引驱动装置定位在与自动导引车前进方向平行的位置；控制自动导引车作匀速直线运动，每台摄像机分别采集地面上的同一特征点在匀速直线运动状态下的连续时间序列视频；采集的特征点在图像序列中的坐标呈线性分布，采用最小二乘法拟合直线，分别计算拟合直线与每台摄像机图像坐标系水平轴的夹角-1，所述夹角即为摄像机坐标系与对应导引驱动装置运动控制坐标系之间的旋转角； 4)得到旋转角ft之后，通过坐标变换即可得特征点在运动控制坐标系中的轨迹，该轨迹应为对应导引驱动装置数量的平行直线；任意两直线m、η间的距离为两导引驱动装置运动控制中心点在垂直于自动导引车前进方向上的距离偏差Λχπ_η; 5)控制导引驱动装置自转至角度传感器的示值为90°的位置，通过机械限位开关将导引驱动装置与车体的相对位置固定，即所有导引驱动装置定位在与自动导引车前进方向垂直的位置，控制自动导引车作侧向平移运动；在地面上布置特征点Pi,所述特征点位于同一条直线上，且每个特征点位于对应导引驱动装置摄像机的视野范围之内，特征点个数对应导引驱动装置个数，特征点间的距离由制作标定模板时精确测定，同时尽量保证特征点所在直线与自动导引车前进方向平行；分别采集匕在对应摄像机中的连续时间序列视频，Pi的轨迹为直线，采用最小二乘法拟合直线，计算两导引驱动装置m、η运动控制中心点在自动导引车前进方向上的距离偏差Aym_n;由于导引驱动装置之间的姿态偏差0在自动导引车运行过程中可控，从而确定导引驱动装置运动控制坐标系之间的位姿关系； 6)通过坐标变换可得任意两导引驱动装置运动控制坐标系OkiXkiYkiZiu与OwXwYwZkj之间的位姿关系；以任一导引驱动装置运动控制坐标系为参照，即可建立自动导引车的整车运动控制坐标系。
【文档编号】G06T7/00GK103529838SQ201310444568
【公开日】2014年1月22日 申请日期:2013年9月23日 优先权日:2013年9月23日
【发明者】武星, 楼佩煌, 钱晓明, 石陈陈, 王龙军, 朱琳军, 刘旭, 沈伟良 申请人:南京航空航天大学