[發明專利]一種混凝土泵車臂架末端位置姿態的攝像測量方法

有效

• 申請號: 201310074634.7
• 申請日: 2013-03-08
• 公開（公告）號: CN103175512A
• 公開（公告）日: 2013-06-26
• 發明（設計）人: 于起峰;張紅良;尚洋;蘇昂;郭鵬宇
• 申請（專利權）人: 中國人民解放軍國防科學技術大學
• 主分類號: G01C11/36
• 分類號: G01C11/36
• 代理公司: 湖南省國防科技工業局專利中心 43102
• 代理人: 馮青

技術領域

本發明涉及工程機械、計算機視覺技術領域，具體指在混凝土泵車臂架末端安裝攝像測量系統，實時測量泵車臂架末端位置姿態的方法。

背景技術

混凝土泵車臂架末端的穩定控制對于提高工程施工的安全性和效率具有十分重要的意義，臂架末端的位置姿態（位姿）實時測量是穩定控制的前提。目前混凝土泵車主要依靠測量各節臂間的油缸油壓、傾角等信息得到各節臂的位置姿態，進而得到臂架末端的位置姿態。目前的測量方法用于臂架末端穩定控制，存在響應延遲大、臂架振動幅度大等問題。

在計算機視覺領域，可以利用攝像機構建攝像測量系統，通過分析處理攝像機視場中景物的視頻圖像特征，計算攝像機的運動或攝像機視場中目標的運動。本發明利用計算機視覺領域相關技術，泵車臂架上安裝攝像機，構建混凝土泵車位姿的攝像測量系統，實時測量泵車臂架末端的位置姿態變化，用于臂架末端的位姿控制或測試。

發明內容

本發明提供一種混凝土泵車臂架末端位姿的攝像測量方法，具體指在混凝土泵車臂架末端安裝攝像機，構建攝像測量系統。系統包含一臺或多臺攝像機（可見光、紅外攝像機等）和數據處理器（微機或DSP等）、數據傳輸線等。攝像機安裝在泵車臂架末端，數據處理器可與攝像機集成安裝在一起，也可單獨安裝在泵車其他部位，數據傳輸線用于傳送攝像機圖像和傳送測量數據給泵車控制系統。系統組成示意圖如圖1所示。

攝像測量系統工作時，攝像機隨泵車臂架末端運動，對視場內的景物實時成像，數據處理器實時檢測處理視頻圖像上景物（如地面、建筑物、人工設定標志等）的變化，實時計算泵車臂架末端的位姿變化。計算測量結果實時傳輸給泵車控制系統，用于泵車臂架末端位姿控制或測試。具體實施過程為：

1)?在泵車臂架末端處安裝攝像機系統（包含一臺或多臺攝像機），在泵車上安裝數據處理器（微機、DSP等）和數據傳輸線等，構成泵車臂架末端位姿變化攝像測量系統。

2)?標定攝像測量系統相關參數（包括攝像機內參數、多臺攝像機間的位姿關系等），建立攝像測量坐標系，標定攝像測量坐標系與泵車臂架控制坐標系之間的關系。上述標定可采用平面靶板標定法、控制點標定法、手眼關系標定法等攝像測量、計算機視覺領域的常用攝像系統標定方法。

3)?攝像測量系統工作時，攝像機系統隨泵車臂架末端運動并連續拍攝，將視頻圖像傳送給數據處理器。

4)?數據處理器實時檢測視頻圖像中景物特征的變化，根據上述變化實時計算攝像機系統的運動。該運動計算方法可采用光流法、本質矩陣法、多目交會測量法等攝像測量、計算機視覺領域的運動估計方法。

上述攝像機系統的運動計算結果主要指攝像機系統的位姿變化（相鄰時刻間或相對初始測量時刻），一般為在攝像測量坐標系的表示。由于攝像機固定安裝在泵車臂架末端處，攝像機系統的位姿變化即為泵車臂架末端的位姿變化。

5)?根據步驟2)標定得到的攝像測量坐標系與泵車臂架控制坐標系之間的關系，將步驟4)計算得到的泵車臂架末端的位姿變化轉換到泵車臂架控制坐標系內表示，得到泵車臂架末端位姿變化測量結果。

6)將步驟5)的測量結果實時傳送給泵車控制系統，用于臂架末端位姿控制或測試。

本發明可以達到以下的技術效果：

本發明通過在泵車臂架末端安裝攝像機對景物成像，實時檢測景物在圖像上的變化，實時計算泵車臂架末端的位姿變化，測量方式自動化智能化程度高，適用范圍廣，測量結果可直接用于泵車臂架位姿控制或測試。

本發明同樣可用于其它工程機械部件的位姿測量、測試或控制。

附圖說明

圖1泵車臂架末端位姿變化攝像測量系統組成。

圖2泵車臂架末端位姿變化攝像測量原理示意圖。

具體實施方式

如圖1所示，泵車臂架末端位姿攝像測量系統由一臺或多臺攝像機（可見光、紅外等）、數據處理器（微機、DSP等）和數據傳輸線構成。攝像機安裝在泵車臂架末端，數據處理器可與攝像機安裝在一起也可安裝在泵車其他位置。攝像機用于對泵車作業附近區域景物成像，數據處理器用于圖像分析處理和臂架末端位姿計算，數據傳輸線用于將視頻圖像傳輸給數據處理器和將泵車臂架末端位姿測量結果傳送給泵車控制系統。