1.一种基于靶标的单目视觉挖掘机位姿测量系统,其特征在于,包括靶标、单目相机(8)和计算模块,所述靶标包括安装在挖掘机同一侧的铲斗靶标(2)、斗杆靶标(4)和动臂靶标(6),所述铲斗靶标(2)固定在铲斗连接杆(9)上靠近铲斗(1)的一端,所述斗杆靶标(4)固定在斗杆(3)上,所述动臂靶标(6)固定在动臂(5)上,所述单目相机(8)的视野覆盖铲斗靶标(2)、斗杆靶标(4)和动臂靶标(6),所述计算模块用于根据单目相机(8)采集到的靶标图像计算各个靶标的空间六自由度参数。
2.根据权利要求1所述的一种基于靶标的单目视觉挖掘机位姿测量系统,其特征在于,所述铲斗靶标(2)、斗杆靶标(4)和动臂靶标(6)的形状相同,均为3×3的黑白相间正方形。
3.根据权利要求2所述的一种基于靶标的单目视觉挖掘机位姿测量系统,其特征在于,所述黑白相间正方形的每个边缘具有8个凸出的黑色矩形区域。
4.根据权利要求1所述的一种基于靶标的单目视觉挖掘机位姿测量系统,其特征在于,2
所述铲斗靶标(2)、斗杆靶标(4)和动臂靶标(6)的大小相同,均为228×228mm。
5.一种基于权利要求1所述的单目视觉挖掘机位姿测量系统的挖掘机位姿测量方法,其特征在于,包括以下步骤:步骤1、测量系统初始化:通过建立标定物上坐标已知的点与其图像点之间的对应,利用标定算法获得相机的内外参数;校正镜头畸变,使用最大似然估计进行优化,得到相机的内参数矩阵K、外参数旋转矩阵R,平移向量t和径向畸变参数k1,k2,k3,切向畸变参数p1,p2;
步骤2、图像采集:当挖掘机处于工作状态时,利用单目相机(8)拍摄挖掘机整个工作过程中铲斗靶标(2)、斗杆靶标(4)和动臂靶标(6)的数字图像,并将拍摄到的数字图像传递给计算机;
步骤3、靶标检测:根据单目相机(8)拍摄到的图案,得到铲斗靶标(2)、斗杆靶标(4)和动臂靶标(6)上多个鞍点的图像坐标(ui,vi),其中i为整数;
步骤4、工作装置世界坐标系的位姿计算:获取实际挖掘机工作装置的工作平面与图像平面之间的映射关系,通过步骤1得到的相机的内参数矩阵K、外参数旋转矩阵R,平移向量t和径向畸变参数k1,k2,k3,切向畸变参数p1,p2,以及步骤3测量到的靶标内部鞍点的图像坐标经坐标之间的变换关系转换成该点的实际坐标;
步骤5、实时性动态监测:重复步骤2至步骤4,实时的动态监测出挖掘机处于工作状态时工作装置的位姿信息。
6.根据权利要求5所述的一种基于靶标的单目视觉挖掘机位姿测量方法,其特征在于,步骤4中,坐标系之间的转换关系如下:其中
x′=XC/ZC,y′=YC/ZC,
x″=(1+k1r2+k2r4+k3r6)x′+2p1x′y′+p2(r2+2x′2),y″=(1+k1r2+k2r4+k3r6)y′+p1(r2+2y′2)+2p2x′y′,r2=x′2+y′2’,
u=fx·x″+Cx,v=fy·y″+cy;
其中,(u,v)为图像坐标,(Xw,Yw,Zw)为世界坐标,(XC,YC,ZC)为相机坐标,fx为图像水平轴的尺度因子,fy为图像垂直轴的尺度因子,(u0,v0)为主点坐标(即光轴与图像平面的交点),R是标定板平面相对于相机坐标系的旋转矩阵,t是靶标相对于相机坐标系的平移向量,s是比例因子,x′、y′、x″、y″和r均为中间变量;
从上述方程可以得到R和t:
tT=[t1 t2 t3];
将检测到的鞍点i的图像坐标系坐标(ui,vi)转换为以动臂(5)、斗杆(3)和铲斗(1)被拍摄平面的世界坐标系坐标(Xw,Yw,Zw)和三个转角(α,β,γ):其中α是靶标绕z轴的转角,β是靶标绕y轴的转角,γ是靶标绕x轴的转角;
故得到靶标的六自由度(α,β,γ,Xw,Yw,Zw)参数,此六自由度参数是以相机为原点的世界坐标系的坐标参数。
7.根据权利要求5所述的一种基于靶标的单目视觉挖掘机位姿测量方法,其特征在于,步骤3的具体过程为:首先进行连通区域检测和识别标记的靶标;然后根据连通区域的面积大小和欧拉数作为基本判断准则,识别靶标内部的标记区域;接着进行四边形拟合,计算测量图像的梯度,获取区域边缘和靶标的四个边缘方向;接着获取的边缘进行最小二乘拟合计算,得到四条直线作为初始值,计算四条直线的极坐标方程,并对其极角按大小进行逆时针排序,进行铲斗靶标(2)、斗杆靶标(4)和动臂靶标(6)内的鞍点检测和亚像素细化;最后得到铲斗靶标(2)、斗杆靶标(4)和动臂靶标(6)上多个鞍点的图像坐标(ui,vi),其中i为整数。
8.根据权利要求7所述的一种基于靶标的单目视觉挖掘机位姿测量方法,其特征在于,所述骤3中,若有靶标图案中的某些鞍点未检测到,根据鞍点之间的几何关系恢复检测过程中的丢失鞍点。