专利名称：一种混凝土泵车臂架末端位置姿态的摄像测量方法
技术领域：
本发明涉及工程机械、计算机视觉技术领域，具体指在混凝土泵车臂架末端安装摄像测量系统，实时测量泵车臂架末端位置姿态的方法。
背景技术：
混凝土泵车臂架末端的稳定控制对于提高工程施工的安全性和效率具有十分重要的意义，臂架末端的位置姿态(位姿)实时测量是稳定控制的前提。目前混凝土泵车主要依靠测量各节臂间的油缸油压、倾角等信息得到各节臂的位置姿态，进而得到臂架末端的位置姿态。目前的测量方法用于臂架末端稳定控制，存在响应延迟大、臂架振动幅度大等问题。在计算机视觉领域，可以利用摄像机构建摄像测量系统，通过分析处理摄像机视场中景物的视频图像特征，计算摄像机的运动或摄像机视场中目标的运动。本发明利用计算机视觉领域相关技术，泵车臂架上安装摄像机，构建混凝土泵车位姿的摄像测量系统，实时测量泵车臂架末端的位置姿态变化，用于臂架末端的位姿控制或测试。
发明内容
本发明提供一种混凝土泵车臂架末端位姿的摄像测量方法，具体指在混凝土泵车臂架末端安装摄像机，构建摄像测量系统。系统包含一台或多台摄像机(可见光、红外摄像机等)和数据处理器(微机或DSP等)、数据传输线等。摄像机安装在泵车臂架末端，数据处理器可与摄像机集成安装在一起，也可单独安装在泵车其他部位，数据传输线用于传送摄像机图像和传送测量数据给泵车控制系统。系统组成示意图如图1所示。摄像测量系统工作时，摄像机随泵车臂架末端运动，对视场内的景物实时成像，数据处理器实时检测处理视频图像上景物(如地面、建筑物、人工设定标志等)的变化，实时计算泵车臂架末端的位姿变化。计算测量结果实时传输给泵车控制系统，用于泵车臂架末端位姿控制或测试。具体实施过程为:I)在泵车臂架末端处安装摄像机系统(包含一台或多台摄像机)，在泵车上安装数据处理器(微机、DSP等)和数据传输线等，构成泵车臂架末端位姿变化摄像测量系统。2)标定摄像测量系统相关参数(包括摄像机内参数、多台摄像机间的位姿关系等)，建立摄像测量坐标系，标定摄像测量坐标系与泵车臂架控制坐标系之间的关系。上述标定可采用平面靶板标定法、控制点标定法、手眼关系标定法等摄像测量、计算机视觉领域的常用摄像系统标定方法。3)摄像测量系统工作时，摄像机系统随泵车臂架末端运动并连续拍摄，将视频图像传送给数据处理器。4)数据处理器实时检测视频图像中景物特征的变化，根据上述变化实时计算摄像机系统的运动。该运动计算方法可采用光流法、本质矩阵法、多目交会测量法等摄像测量、计算机视觉领域的运动估计方法。
上述摄像机系统的运动计算结果主要指摄像机系统的位姿变化(相邻时刻间或相对初始测量时刻)，一般为在摄像测量坐标系的表示。由于摄像机固定安装在泵车臂架末端处，摄像机系统的位姿变化即为泵车臂架末端的位姿变化。5)根据步骤2)标定得到的摄像测量坐标系与泵车臂架控制坐标系之间的关系，将步骤4)计算得到的泵车臂架末端的位姿变化转换到泵车臂架控制坐标系内表示，得到泵车臂架末端位姿变化测量结果。6)将步骤5)的测量结果实时传送给泵车控制系统，用于臂架末端位姿控制或测试。本发明可以达到以下的技术效果:本发明通过在泵车臂架末端安装摄像机对景物成像，实时检测景物在图像上的变化，实时计算泵车臂架末端的位姿变化，测量方式自动化智能化程度高，适用范围广，测量结果可直接用于泵车臂架位姿控制或测试。本发明同样可用于其它工程机械部件的位姿测量、测试或控制。
图1泵车臂架末端位姿变化摄像测量系统组成。图2泵车臂架末端位姿变化摄像测量原理示意图。
具体实施方式
`如图1所示，泵车臂架末端位`姿摄像测量系统由一台或多台摄像机(可见光、红外等)、数据处理器(微机、DSP等)和数据传输线构成。摄像机安装在泵车臂架末端，数据处理器可与摄像机安装在一起也可安装在泵车其他位置。摄像机用于对泵车作业附近区域景物成像，数据处理器用于图像分析处理和臂架末端位姿计算，数据传输线用于将视频图像传输给数据处理器和将泵车臂架末端位姿测量结果传送给泵车控制系统。泵车臂架末端位姿变化测量原理如图2所示，由于臂架末端的运动，不同时刻相同景物在摄像机图像上的位置不同，通过检测景物在图像上的变化可以计算得到泵车臂架末端的位置姿态变化情况。根据视频图像计算泵车臂架末端运动的方法可以采用计算机视觉领域的光流法、本质矩阵法、多目交会测量法等，其中多目交会测量法的实现方式具体描述如下。如图2所示，首先在当前时刻(t2)多台摄像机同步采集的图上检测、匹配多个景物特征，多目交会测量得到这些特征在当前成像时刻摄像测量坐标系(Ct2)的坐标或方程表示。设在双摄像机同一时刻拍摄的图像中某特征点图像坐标分别为(Xl，Y1)和(X2，I2), M1和M2分别为已标定的双摄像机投影矩阵(包含摄像机内参数和摄像机在测量坐标系的位姿外参数)，根据摄像测量原理，该点特征在摄像测量坐标系内的坐标Γ = [x，y，z]T满足
权利要求
1.一种混凝土泵车臂架末端位置姿态的摄像测量方法，其特征在于，在混凝土泵车臂架末端安装摄像机系统，通过测量摄像机视频图像上景物的变化，实时计算泵车臂架末端的位姿变化，测量结果实时传输给泵车控制系统，用于泵车臂架末端位姿控制或测试， 其实施步骤为: 1)在泵车臂架末端处安装摄像机系统，包含一台或多台摄像机，在泵车上安装数据处理器和数据传输线，构成泵车臂架末端位姿变化摄像测量系统； 2)标定摄像测量系统相关参数，包括摄像机内参数、多台摄像机间的位姿关系等，建立摄像测量坐标系，标定摄像测量坐标系与泵车臂架控制坐标系之间的关系； 3)摄像测量系统工作时，摄像机系统随泵车臂架末端运动连续拍摄，将视频图像传送给数据处理器； 4)数据处理器实时检测视频图像中景物特征的变化，根据上述变化实时计算摄像机系统的运动，运动计算方法可采用光流法、本质矩阵法、多目交会测量法； 上述摄像机系统的运动计算结果为摄像机系统的位姿变化，相邻时刻间或相对初始测量时刻，一般为在摄像测量坐标系的表示，由于摄像机固定安装在泵车臂架末端处，摄像机系统的位姿变化即为泵车臂架末端的位姿变化； 5)根据步骤2)标定得到的摄像测量坐标系与泵车臂架控制坐标系之间的关系，将步骤4)计算得到的泵车臂架末端的位姿变化转换到泵车臂架控制坐标系内表示，得到泵车臂架末端位姿变化测量结果； 6)将步骤5)的测量结果实时传送给泵车控制系统，用于臂架末端位姿控制或测试。
2.根据权利要求1所述的一种混凝土泵车臂架末端位置姿态的摄像测量方法，其特征在于，所述步骤4)中多目交会测量法的具体内容如下: 首先在当前6时刻多台摄像机同步采集的图上检测、匹配多个景物特征，多目交会测量得到这些特征在当前成像时刻摄像测量坐标系Ct2的坐标或方程表示，设在双摄像机同一时刻拍摄的图像中某特征点图像坐标分别为和( , ) ,M1和岣分别为已标定的双摄像机投影矩阵，包含摄像机内参数和摄像机在测量坐标系的位姿外参数，根据摄像测量原理，该点特征在摄像测量坐标系内的坐标f = [^y,zf满足
3.根据权利要求1所述的一种混凝土泵车臂架末端位置姿态的摄像测量方法，其特征在于，所述泵车臂架末端位姿变化摄像测量系统的摄像机为可见光摄像机或红外摄像机，数据处理器为DSP处理器或微机处理器。
全文摘要
本发明提供一种混凝土泵车臂架末端位姿的摄像测量方法。本发明的技术方案是在混凝土泵车臂架末端安装摄像机，构建摄像测量系统。系统包含一台或多台摄像机(可见光、红外摄像机等)和数据处理器(微机或DSP等)、数据传输线等。摄像机安装在泵车臂架末端，数据处理器可与摄像机集成安装在一起，也可单独安装在泵车其他部位，数据传输线用于传送摄像机图像和传送测量数据给泵车控制系统。摄像测量系统工作时，摄像机随泵车臂架末端运动，对视场内的景物实时成像，数据处理器实时检测处理视频图像上景物的变化，实时计算泵车臂架末端的位姿变化。计算测量结果实时传输给泵车控制系统，用于泵车臂架末端位姿控制或测试。本发明也可用于其它工程机械部件的位姿测量、测试或控制。
文档编号G01C11/36GK103175512SQ20131007463
公开日2013年6月26日 申请日期2013年3月8日 优先权日2013年3月8日
发明者于起峰, 张红良, 尚洋, 苏昂, 郭鹏宇 申请人:中国人民解放军国防科学技术大学