CN103175512B - 一种混凝土泵车臂架末端位置姿态的摄像测量方法 - Google Patents
一种混凝土泵车臂架末端位置姿态的摄像测量方法 Download PDFInfo
- Publication number
- CN103175512B CN103175512B CN201310074634.7A CN201310074634A CN103175512B CN 103175512 B CN103175512 B CN 103175512B CN 201310074634 A CN201310074634 A CN 201310074634A CN 103175512 B CN103175512 B CN 103175512B
- Authority
- CN
- China
- Prior art keywords
- coordinate system
- pumping vehicle
- arm rack
- vehicle arm
- pump truck
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Expired - Fee Related
Links
Landscapes
- Length Measuring Devices By Optical Means (AREA)
Abstract
本发明提供一种混凝土泵车臂架末端位姿的摄像测量方法。本发明的技术方案是在混凝土泵车臂架末端安装摄像机,构建摄像测量系统。系统包含一台或多台摄像机(可见光、红外摄像机等)和数据处理器(微机或DSP等)、数据传输线等。摄像机安装在泵车臂架末端,数据处理器可与摄像机集成安装在一起,也可单独安装在泵车其他部位,数据传输线用于传送摄像机图像和传送测量数据给泵车控制系统。摄像测量系统工作时,摄像机随泵车臂架末端运动,对视场内的景物实时成像,数据处理器实时检测处理视频图像上景物的变化,实时计算泵车臂架末端的位姿变化。计算测量结果实时传输给泵车控制系统,用于泵车臂架末端位姿控制或测试。本发明也可用于其它工程机械部件的位姿测量、测试或控制。
Description
技术领域
本发明涉及工程机械、计算机视觉技术领域,具体指在混凝土泵车臂架末端安装摄像测量系统,实时测量泵车臂架末端位置姿态的方法。
背景技术
混凝土泵车臂架末端的稳定控制对于提高工程施工的安全性和效率具有十分重要的意义,臂架末端的位置姿态(位姿)实时测量是稳定控制的前提。目前混凝土泵车主要依靠测量各节臂间的油缸油压、倾角等信息得到各节臂的位置姿态,进而得到臂架末端的位置姿态。目前的测量方法用于臂架末端稳定控制,存在响应延迟大、臂架振动幅度大等问题。
在计算机视觉领域,可以利用摄像机构建摄像测量系统,通过分析处理摄像机视场中景物的视频图像特征,计算摄像机的运动或摄像机视场中目标的运动。本发明利用计算机视觉领域相关技术,泵车臂架上安装摄像机,构建混凝土泵车位姿的摄像测量系统,实时测量泵车臂架末端的位置姿态变化,用于臂架末端的位姿控制或测试。
发明内容
本发明提供一种混凝土泵车臂架末端位姿的摄像测量方法,具体指在混凝土泵车臂架末端安装摄像机,构建摄像测量系统。系统包含一台或多台摄像机(可见光、红外摄像机等)和数据处理器(微机或DSP等)、数据传输线等。摄像机安装在泵车臂架末端,数据处理器可与摄像机集成安装在一起,也可单独安装在泵车其他部位,数据传输线用于传送摄像机图像和传送测量数据给泵车控制系统。系统组成示意图如图1所示。
摄像测量系统工作时,摄像机随泵车臂架末端运动,对视场内的景物实时成像,数据处理器实时检测处理视频图像上景物(如地面、建筑物、人工设定标志等)的变化,实时计算泵车臂架末端的位姿变化。计算测量结果实时传输给泵车控制系统,用于泵车臂架末端位姿控制或测试。具体实施过程为:
1) 在泵车臂架末端处安装摄像机系统(包含一台或多台摄像机),在泵车上安装数据处理器(微机、DSP等)和数据传输线等,构成泵车臂架末端位姿变化摄像测量系统。
2) 标定摄像测量系统相关参数(包括摄像机内参数、多台摄像机间的位姿关系等),建立摄像测量坐标系,标定摄像测量坐标系与泵车臂架控制坐标系之间的关系。上述标定可采用平面靶板标定法、控制点标定法、手眼关系标定法等摄像测量、计算机视觉领域的常用摄像系统标定方法。
3) 摄像测量系统工作时,摄像机系统随泵车臂架末端运动并连续拍摄,将视频图像传送给数据处理器。
4) 数据处理器实时检测视频图像中景物特征的变化,根据上述变化实时计算摄像机系统的运动。该运动计算方法可采用光流法、本质矩阵法、多目交会测量法等摄像测量、计算机视觉领域的运动估计方法。
上述摄像机系统的运动计算结果主要指摄像机系统的位姿变化(相邻时刻间或相对初始测量时刻),一般为在摄像测量坐标系的表示。由于摄像机固定安装在泵车臂架末端处,摄像机系统的位姿变化即为泵车臂架末端的位姿变化。
5) 根据步骤2)标定得到的摄像测量坐标系与泵车臂架控制坐标系之间的关系,将步骤4)计算得到的泵车臂架末端的位姿变化转换到泵车臂架控制坐标系内表示,得到泵车臂架末端位姿变化测量结果。
6)将步骤5)的测量结果实时传送给泵车控制系统,用于臂架末端位姿控制或测试。
本发明可以达到以下的技术效果:
本发明通过在泵车臂架末端安装摄像机对景物成像,实时检测景物在图像上的变化,实时计算泵车臂架末端的位姿变化,测量方式自动化智能化程度高,适用范围广,测量结果可直接用于泵车臂架位姿控制或测试。
本发明同样可用于其它工程机械部件的位姿测量、测试或控制。
附图说明
图1泵车臂架末端位姿变化摄像测量系统组成。
图2泵车臂架末端位姿变化摄像测量原理示意图。
具体实施方式
如图1所示,泵车臂架末端位姿摄像测量系统由一台或多台摄像机(可见光、红外等)、数据处理器(微机、DSP等)和数据传输线构成。摄像机安装在泵车臂架末端,数据处理器可与摄像机安装在一起也可安装在泵车其他位置。摄像机用于对泵车作业附近区域景物成像,数据处理器用于图像分析处理和臂架末端位姿计算,数据传输线用于将视频图像传输给数据处理器和将泵车臂架末端位姿测量结果传送给泵车控制系统。
泵车臂架末端位姿变化测量原理如图2所示,由于臂架末端的运动,不同时刻相同景物在摄像机图像上的位置不同,通过检测景物在图像上的变化可以计算得到泵车臂架末端的位置姿态变化情况。根据视频图像计算泵车臂架末端运动的方法可以采用计算机视觉领域的光流法、本质矩阵法、多目交会测量法等,其中多目交会测量法的实现方式具体描述如下。
如图2所示,首先在当前时刻(t2)多台摄像机同步采集的图上检测、匹配多个景物特征,多目交会测量得到这些特征在当前成像时刻摄像测量坐标系(Ct2)的坐标或方程表示。设在双摄像机同一时刻拍摄的图像中某特征点图像坐标分别为(x1,y1)和(x2,y2),M1和M2分别为已标定的双摄像机投影矩阵(包含摄像机内参数和摄像机在测量坐标系的位姿外参数),根据摄像测量原理,该点特征在摄像测量坐标系内的坐标Xc=[x,y,z]T满足
根据公式(1)的两个等式可求解出该点特征坐标Xc=[x,y,z]T。
对于线特征等其他类型特征,利用类似方法可以通过面面交会等确定特征在摄像测量坐标系的方程表示。也可以首先确定特征上的关键点,然后利用交会测量确定点的坐标,最后建立特征的方程表示。
然后在当前测量的特征中匹配查找上一成像时刻(t1)测量的景物特征,计算当前成像时刻与上一成像时刻间共同特征的坐标或方程表示的差异。根据上述共同特征的表示差异以及摄像测量坐标系(Ct1)与泵车臂架控制坐标系(W)间的关系计算泵车臂架末端在两个时刻间的位姿变化在泵车臂架控制坐标系的表示。设时刻t11测量得到第i个特征点在t1时刻摄像测量坐标系的三维坐标为,t2时刻测量得到该特征点在在t2时刻摄像测量坐标系中的三维坐标为。设t1时刻泵车臂架控制坐标系为W,设t1时刻摄像测量坐标系原点的坐标为,摄像测量坐标系与泵车臂架控制坐标系姿态转换矩阵为,、通过标定摄像测量坐标系与泵车臂架控制坐标系间的位姿关系得到。t2时刻摄像测量坐标系位置变化δXw,姿态变化,则有
由(2)可得
当测量多个特征点时,可根据(3)确定摄像测量坐标系在t1、t2两时刻间的位姿变化δXw和。
综合处理各时刻间的位姿变化,可以得到某初始测量时刻至当前测量时刻的泵车臂架末端位姿变化。
Claims (1)
1.一种混凝土泵车臂架末端位置姿态的摄像测量方法,其特征在于,在混凝土泵车臂架末端安装摄像机系统,通过测量摄像机视频图像上景物的变化,实时计算泵车臂架末端的位姿变化,测量结果实时传输给泵车控制系统,用于泵车臂架末端位姿控制或测试,
其实施步骤为:
1) 在泵车臂架末端处安装摄像机系统,包含一台或多台摄像机,在泵车上安装数据处理器和数据传输线,构成泵车臂架末端位姿变化摄像测量系统;
2) 标定摄像测量系统相关参数,建立摄像测量坐标系,标定摄像测量坐标系与泵车臂架控制坐标系之间的关系;
3) 摄像测量系统工作时,摄像机系统随泵车臂架末端运动连续拍摄,将视频图像传送给数据处理器;
4) 数据处理器实时检测视频图像中景物特征的变化,根据上述变化实时计算摄像机系统的运动,运动计算方法采用光流法、本质矩阵法或多目交会测量法;
上述摄像机系统的运动计算结果为相邻时刻间或相对初始测量时刻且在摄像测量坐标系的摄像机系统的位姿变化,由于摄像机固定安装在泵车臂架末端处,摄像机系统的位姿变化即为泵车臂架末端的位姿变化;
5) 根据步骤2)标定得到的摄像测量坐标系与泵车臂架控制坐标系之间的关系,将步骤4)计算得到的泵车臂架末端的位姿变化转换到泵车臂架控制坐标系内表示,得到泵车臂架末端位姿变化测量结果;
6)将步骤5)的测量结果实时传送给泵车控制系统,用于臂架末端位姿控制或测试;
所述步骤4)中多目交会测量法的具体内容如下:
首先在当前时刻 多台摄像机同步采集的图像上检测、匹配多个景物特征,多目交会测量得到这些特征在当前成像时刻摄像测量坐标系Ct2的坐标或方程表示,设在双摄像机同一时刻拍摄的图像中某特征点图像坐标分别为和,和分别为已标定的双摄像机投影矩阵,包含摄像机内参数和摄像机在测量坐标系的位姿外参数,根据摄像测量原理,该特征点在摄像测量坐标系内的坐标满足
, (1)
根据公式(1)的两个等式可求解出该特征点坐标,
对于线特征其他类型特征,利用类似方法,通过面面交会确定特征在摄像测量坐标系的方程表示,也可以首先确定特征上的关键点,然后利用交会测量确定点的坐标,最后建立特征的方程表示,
然后在当前测量的特征中匹配查找上一成像时刻测量的景物特征,计算当前成像时刻与上一成像时刻间共同特征的坐标或方程表示的差异,根据上述共同特征的表示差异以及摄像测量坐标系与泵车臂架控制坐标系间的关系计算泵车臂架末端在两个时刻间的位姿变化在泵车臂架控制坐标系的表示和,设时刻测量得到第个特征点在摄像测量坐标系的三维坐标为, 时刻测量得到该第个特征点在摄像测量坐标系中的三维坐标为, 时刻摄像测量坐标系原点在泵车臂架控制坐标系的坐标为,摄像测量坐标系与泵车臂架控制坐标系姿态转换矩阵为,和通过标定摄像测量坐标系与泵车臂架控制坐标系间的位姿关系得到,则有
, (2)
由(2)可得
(3)
当测量多个特征点时,根据(3)可确定摄像测量坐标系在和两时刻间的位姿变化和,
综合处理各时刻间的位姿变化,可得到初始测量时刻至当前测量时刻的泵车臂架末端位姿变化。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201310074634.7A CN103175512B (zh) | 2013-03-08 | 2013-03-08 | 一种混凝土泵车臂架末端位置姿态的摄像测量方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201310074634.7A CN103175512B (zh) | 2013-03-08 | 2013-03-08 | 一种混凝土泵车臂架末端位置姿态的摄像测量方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN103175512A CN103175512A (zh) | 2013-06-26 |
CN103175512B true CN103175512B (zh) | 2014-12-31 |
Family
ID=48635542
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201310074634.7A Expired - Fee Related CN103175512B (zh) | 2013-03-08 | 2013-03-08 | 一种混凝土泵车臂架末端位置姿态的摄像测量方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN103175512B (zh) |
Families Citing this family (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN106981082B (zh) * | 2017-03-08 | 2020-04-17 | 驭势科技(北京)有限公司 | 车载摄像头标定方法、装置及车载设备 |
JP6420404B1 (ja) * | 2017-04-26 | 2018-11-07 | ファナック株式会社 | 物体認識装置 |
CN107727151A (zh) * | 2017-11-10 | 2018-02-23 | 公安部上海消防研究所 | 一种举高消防车臂架运动状态动态测试装置 |
CN110567728B (zh) * | 2018-09-03 | 2021-08-20 | 创新先进技术有限公司 | 用户拍摄意图的识别方法、装置及设备 |
CN109538208A (zh) * | 2018-12-21 | 2019-03-29 | 冀中能源峰峰集团有限公司 | 一种掘进机截割头复合定位系统及方法 |
CN110349290A (zh) * | 2019-07-12 | 2019-10-18 | 徐州徐工施维英机械有限公司 | 车辆监控系统、方法和车辆 |
CN110487249A (zh) * | 2019-07-17 | 2019-11-22 | 广东工业大学 | 一种用于结构三维振动测量的无人机标定方法 |
Family Cites Families (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN100532244C (zh) * | 2006-09-26 | 2009-08-26 | 上海海事大学 | 港口运动集装箱卡车定位方法及装置 |
CN101469986B (zh) * | 2007-12-27 | 2011-06-22 | 鸿富锦精密工业(深圳)有限公司 | 模糊边界的自动寻点系统及方法 |
TW201030362A (en) * | 2009-02-09 | 2010-08-16 | Univ Nat Taiwan | Method for implementing GPS surveying field work planning using 3D topographic information and method for analyzing 3D topographic information |
CN102042807B (zh) * | 2010-10-29 | 2012-06-20 | 中国科学技术大学 | 一种目标空间坐标的柔性立体视觉测量装置 |
CN102795547B (zh) * | 2012-08-31 | 2014-07-16 | 中国人民解放军国防科学技术大学 | 起重机吊钩位置和摆角的实时摄像测量方法 |
CN102829769B (zh) * | 2012-08-31 | 2014-05-14 | 中国人民解放军国防科学技术大学 | 基于结构光视觉传感器的集装箱位置姿态测量方法 |
-
2013
- 2013-03-08 CN CN201310074634.7A patent/CN103175512B/zh not_active Expired - Fee Related
Also Published As
Publication number | Publication date |
---|---|
CN103175512A (zh) | 2013-06-26 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN103175512B (zh) | 一种混凝土泵车臂架末端位置姿态的摄像测量方法 | |
CN102798350B (zh) | 一种臂架挠度的测量方法、装置及系统 | |
JP6061205B2 (ja) | 構造物変位の常時監視方法及びその装置 | |
EP3631360B1 (en) | Infrastructure positioning camera system | |
US8412418B2 (en) | Industrial machine | |
US10406645B2 (en) | Calibration approach for camera placement | |
US10646975B2 (en) | Measurement, layout, marking, firestop stick | |
CN102798456B (zh) | 一种工程机械臂架系统工作幅度的测量方法、装置及系统 | |
CN104061876B (zh) | 基于数字图像测量原理的建筑模板施工监测系统 | |
CN112880642B (zh) | 测距系统和测距方法 | |
KR101309443B1 (ko) | 모션 캡처를 이용한 구조물 모니터링 장치 및 방법 | |
KR101283413B1 (ko) | 적외선 열화상 카메라를 이용한 구조물의 3차원 실시간 영상계측 모니터링 시스템 | |
CN105865349B (zh) | 一种大型建筑物位移监测方法 | |
CN103075999B (zh) | 基于图像的实时多目标位置检测方法和系统 | |
CN103090845A (zh) | 一种基于多影像的远程测距方法 | |
CN109035343A (zh) | 一种基于监控相机的楼层相对位移测量方法 | |
JP3897984B2 (ja) | 監視カメラのキャリブレーション方法及び道路監視用カメラ | |
KR101405097B1 (ko) | 모션캡처를 이용한 구조물의 안정성 평가 장치 및 방법 | |
US20230324167A1 (en) | Laser scanner for verifying positioning of components of assemblies | |
KR101292074B1 (ko) | 카메라를 이용한 계측 시스템 및 이를 이용한 카메라 캘리브레이션 방법 | |
JP2006017676A (ja) | 計測システムおよび計測方法 | |
CN102779341B (zh) | 一种新型的基坑施工过程支撑位置的识别方法 | |
FI121688B (fi) | Rakentamisen työn laadun arviointi laserpohjaisen etäisyyskuvan avulla | |
CN110879057B (zh) | 一种基于激光和图像的空间测算方法 | |
RU2562602C2 (ru) | Система диагностики технического состояния магистрального трубопровода на участках надземных переходов |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
C10 | Entry into substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
C14 | Grant of patent or utility model | ||
GR01 | Patent grant | ||
CF01 | Termination of patent right due to non-payment of annual fee |
Granted publication date: 20141231 |
|
CF01 | Termination of patent right due to non-payment of annual fee |