帶死區(qū)的PTZ攝像頭模糊PID跟蹤方法研究

梅權(quán)杰，吳功平，付 博，殷慶斌

（1.武漢大學動力與機械學院，湖北 武漢 430072；2.國網(wǎng)吉林省電力有限公司白山供電公司，吉林 白山 134300）

1 引言

機器視覺捕獲圖像信息是機器人判斷自身運動狀態(tài)，完成巡檢任務(wù)目標解析的主要方法。其中主動視覺是對移動目標實時跟蹤技術(shù)中的一個重要研究方向，使得安裝于固定位置的攝像機能夠根據(jù)目標位置和方向信息進行鏡頭位姿調(diào)整。目前常用的主動視覺攝像機為PTZ（Pan/Tilt/Zoom）攝像機，其主要控制方法如下：文獻[1]采用KCF目標跟蹤方法并使用粒子濾波框架對目標進行狀態(tài)預(yù)測，基于跟蹤結(jié)果使用PID算法對PTZ攝像機進行協(xié)調(diào)控制；文獻[2]運用模糊控制方法對PTZ攝像機進行運動控制，在控制方向上采取優(yōu)先控制策略，對比目標質(zhì)心在視場中x和y兩個方向的位置偏差，使攝像機優(yōu)先轉(zhuǎn)動至偏差大的方向以完成校準，而在轉(zhuǎn)速控制方面則通過設(shè)置速度比例系數(shù)來線性調(diào)節(jié)攝像頭轉(zhuǎn)速，最后通過波門面積對比設(shè)定閾值來確定縮放操作；文獻[3]對PTZ攝像機進行模型辨識和建立動態(tài)矩陣，通過仿真和試驗反復(fù)調(diào)整控制參數(shù)對PTZ攝像機實現(xiàn)主動控制以實現(xiàn)視覺目標跟蹤，但對模型的匹配度要求較高；文獻[4]采用P控制器控制PTZ攝像頭實現(xiàn)目標跟蹤，并且通過增加比例項減少持續(xù)跟蹤過程中跟蹤誤差引起的劇烈振蕩；文獻[5]綜合計算位置偏差和誤差積累，采用PI控制器控制攝像頭跟蹤目標。

在機器人跟蹤目標過程中，搭載在移動機器人平臺上的PTZ攝像機通過定位目標位置來觀察不同場景中的細節(jié)，且利用主動視覺來觀察目標物。但是，跟蹤中圖像的穩(wěn)定性和振蕩性會影響跟蹤目標的精度。以高壓輸電線路巡檢機器人[6]巡檢作業(yè)為研究對象，基于巡檢機器人搭建的主動目標跟蹤平臺，提出運用帶死區(qū)的模糊PID控制方法，對架空高壓輸電線桿塔的金具作為目標物進行跟蹤。實驗結(jié)果表明，此算法能夠?qū)崿F(xiàn)基于PTZ攝像機的主動視覺跟蹤，較好的控制采集圖像的穩(wěn)定性，降低圖像振蕩。

2 PTZ攝像機目標跟蹤平臺

2.1 機器人平臺與工作環(huán)境介紹

以工作在高塔架空地線上的巡檢機器人搭建PTZ攝像機主動視覺目標跟蹤平臺。機器人結(jié)構(gòu)包括兩套安裝在同一水平導(dǎo)軌上的機械臂和一套收展臂機構(gòu)，其中機械臂是由行走輪機構(gòu)、壓緊輪機構(gòu)和松鎖臂機構(gòu)共同組成的輪臂復(fù)合式結(jié)構(gòu)。兩臺SONY SNC-WR630系列高清PTZ網(wǎng)絡(luò)攝像機對稱安裝在機器人控制箱兩側(cè)。機器人行走輪安裝了軸后編碼器，壓緊輪安裝了霍爾傳感器，機箱內(nèi)置傾角傳感器，三者輔助機器人完成自動運行。巡檢機器人外觀，如圖1所示。

圖1 機器人結(jié)構(gòu)圖Fig.1 The Robot Structure

機器人在高壓輸電線上的運行過程包括直線段運行和越障，其中越障根據(jù)障礙物類型分為越金具和越塔，金具為防震錘，越塔根據(jù)塔型分為“越直線塔”和“越耐張塔”兩種。機器人通過對不同機構(gòu)的組合動作實現(xiàn)“滾動越障”和“蠕動越障”。

（1）“滾動越障”即為雙臂壓緊輪松開，滾動越過障礙物；

（2）“蠕動越障”即為在一只機械臂行走輪保持制動狀態(tài)并且壓緊輪保持壓緊狀態(tài)下，另外一只機械臂通過壓緊輪松開，行走輪配合收展臂機構(gòu)向內(nèi)或向外實現(xiàn)單臂越過障礙物。

機器人巡檢作業(yè)任務(wù)即為在直線段行駛過程中拍攝桿塔金具，具體包括防震錘、絕緣子串、船型線夾和拉線金具等，均可作為主動跟蹤對象。

2.2 機器人自主定位方法

為便于機器人越過塔頭，對直線塔和耐張塔分別采用了C型掛板和耐張過橋的改造結(jié)構(gòu)[7]，而機器人通過機械結(jié)構(gòu)和傳感器融合定位方法完成自主定位[8]為主動視覺控制提供了必要條件，定位方法，如圖2所示。

圖2 機器人自主定位方法Fig.2 Automatic Location Method of Robot

機器人由耐張桿塔運動至直線桿塔，以耐張過橋中點為原點建立桿塔坐標系{A}，同時建立機器人坐標系{B}，在任意位置，可通過行走輪編碼器、壓緊輪霍爾傳感器和傾角傳感器記錄并求解出機器人相對坐標原點OA的位置偏移量ΔyB、ΔzB和由桿塔轉(zhuǎn)角引起的角度偏移量α，則通過坐標分解即可得到機器人坐標系原點OB相對坐標系{A}的空間坐標ApBo，如式（1）所示。

3 目標跟蹤模型與方法

3.1 跟蹤控制量求解

建立機器人運動過程中需要跟蹤的目標信息數(shù)據(jù)庫，并建立攝像機坐標系{C}，如圖3所示。圖中φ為攝像機安裝角，ΔxC、ΔyC分別為坐標系{C}在x和y方向上的偏移，機器人可基于定位信息計算出目標物在PTZ攝像機坐標系{C}中的坐標，進一步轉(zhuǎn)化為控制量。

圖3 攝像機坐標系分解圖Fig.3 The Decomposition Diagram of Camera Coordinate System

在巡檢過程中，設(shè)t=t0時刻機器人已完全越過防震錘，開始目標跟蹤位置為D，機器人自D點開始跟蹤目標。設(shè)時間間隔δ，在時間tn=t0+nδ(n=1，2，...，N)時，機器人到達Dn點，由定位算法得到機器人在沿導(dǎo)線豎直平面的y和z兩個方向的定位距離為Ay(tn)和Az(tn)，同時通過傾角傳感器測得沿導(dǎo)線方向的傾角為θ(tn)，則對于在坐標系{A}中坐標為Ap=(Ax0，Ay0，Az0)的目標，其在攝像機坐標系{C}中的坐標可通過如下坐標轉(zhuǎn)換關(guān)系求得：

式中：xB、yB、zB—坐標系{B}的坐標軸。通過控制攝像機的兩個方位使其視軸對準目標物，由圖3 可得對于目標物Cp=(Cx0，Cy0，Cz0)，在攝像機坐標系{C}中的位置分解，如圖4所示。

由分解圖可得控制量Pan和Tilt分別如下：

式中：pan0—攝像機Pan方向初始角度；tilt0—Tilt方向初始角度。則在連續(xù)跟蹤時間內(nèi)，形成了攝像機位置跟蹤曲線t-pan、t-tilt。

3.2 PTZ攝像機控制方法

PTZ攝像機在主動跟蹤目標時需要根據(jù)目標位置調(diào)整自身鏡頭位姿。使用的PTZ攝像機提供了基于C++的CGI（Command Get/Inquiry）命令控制方式，主要包括以下三種：（1）絕對位置控制：Pan、Tilt，速度（Pan和Tilt均為四位16進制數(shù)）；（2）方向速度控制：方向，速度（對Pan，方向為right/left；對Tilt，方向為up/down）；（3）位置反饋：Inqury=Pan，Tilt，Zoom。

對攝像機在Pan方向和Tilt方向的速度控制等級進行參數(shù)標定，結(jié)果如圖5、圖6所示。由圖5和圖6可知，雖然攝像機的調(diào)速范圍較寬，且呈非均勻分布，但實際速度控制量只能取有限的等級，低速區(qū)域適合減弱旋轉(zhuǎn)運動模糊；高速區(qū)域適合快速到達跟蹤曲線的起始點以及波動較大的點。

圖5 Pan等級Fig.5 Pan Level

圖6 Tilt等級Fig.6 Tilt Level

4 帶死區(qū)的模糊PID控制方法

在實際目標跟蹤問題中，考慮到目標位置不斷變化和PTZ攝像機速度控制等級的非均勻分布的特點，為了能夠穩(wěn)定有效地跟蹤巡檢目標，采用帶死區(qū)的模糊PID控制方法動態(tài)調(diào)節(jié)PID參數(shù)，該模型包含模糊控制器和PID控制器，其結(jié)構(gòu)，如圖7所示。

圖7 模糊PID控制器設(shè)計Fig.7 The Design of Fuzzy PID Controller

4.1 模糊控制器結(jié)構(gòu)

由自主定位目標跟蹤算法得到的PTZ攝像機目標位置為給定信號，實際反饋位置為輸出信號，對pan和tilt兩個方向均選取角度偏差e和偏差變化率ec構(gòu)成輸入語言變量，選取PID 的ΔKp、ΔKi、ΔKd增益控制量構(gòu)成輸出語言變量。

4.1.1 變量模糊化

通過實驗確定輸入和輸出的基本論域，根據(jù)量化因子和比例因子分別將輸入和輸出轉(zhuǎn)化到論域，如式（4）所示。

定義輸入和輸出論域模糊量語言值均為e、ec、ΔKp、ΔKi、ΔKd=｛NB、NM、NS、ZE、PM、PS、PB｝，隸屬度函數(shù)，如圖8所示。

圖8 隸屬度函數(shù)Fig.8 The Subordinating Degree Function

4.1.2 模糊推理及去模糊化

模糊推理是模糊控制器的核心，能根據(jù)模糊邏輯中的蘊涵關(guān)系及推理規(guī)則從輸入模糊量推導(dǎo)出輸出模糊量。通過實驗經(jīng)驗總結(jié)出推理規(guī)則，如表1所示。采用“重心法[9-10]”將輸出模糊量去模糊化，再經(jīng)過輸出比例因子的尺度變換得到最終的實際輸出ΔKp、ΔKi、ΔKd，如式（5）所示。

式中：fij=ui(e)·uj(ec)；ui(e)—e的隸屬度；uj(ec)—ec的隸屬度；Ku—比例因子；uij的值由模糊規(guī)，如表1所示。

表1 模糊PID推理規(guī)則表Tab.1 The Rules of Fuzzy Control

4.2 帶死區(qū)的PID控制器結(jié)構(gòu)

采用離散位置式PID[11]控制方法，控制量計算，如式（6）所示。

式中：Kp、Ki、Kd—由模糊控制器在線整定所得，如式（7）所示。

式中：Kp0=0.5、Ki0=0.2、Kd0=0.2—PID初始整定值；對于由模糊控制修正后計算求得的u（k），根據(jù)其值的大小和正負按照2.1中速度等級測算結(jié)果轉(zhuǎn)化為實際控制等級和控制方向。

由于PTZ 攝像機控制等級數(shù)量有限，在誤差較小時，模糊PID控制器會解算選擇低控制等級，使攝像機在單位時間內(nèi)轉(zhuǎn)動的角度大于該誤差，無法到達目標位置，易處于低等級方向頻繁切換狀態(tài)，導(dǎo)致巡檢畫面極不穩(wěn)定，且會使攝像機自身產(chǎn)生機械磨損。因此，采用帶死區(qū)的PID[10]，其控制算式，如式（8）所示。

即當計算誤差小于設(shè)定誤差時，令e（k）=0，則此時攝像機停止動作，式中e0可通過攝像機由實驗確定。

4.3 Zoom控制

針對PTZ攝像機Zoom控制中調(diào)整焦距倍率問題，可根據(jù)目標相對PTZ攝像機距離進行調(diào)整。

根據(jù)3.1中圖4可得目標相對PTZ攝像機視場中心距離，如式（9）所示。

文中使用的攝像機包括30級倍率，根據(jù)距離做出的調(diào)整策略，如表2所示。

表2 Zoom倍率調(diào)整策略Tab.2 The Adjustment Strategy of Zoom Ratio

5 實驗與驗證

基于VS2008和攝像機提供的API接口搭建攝像頭主動視覺目標跟蹤軟件平臺（CVS人機交互界面），通過該界面可得到主動視覺目標跟蹤圖像結(jié)果，如圖9所示。

圖9 CVS人機交互界面Fig.9 CVS Man-Machine Interface

在搭建的模擬實驗平臺上通過機器人采集連續(xù)運行過程中的定位信息，并計算得到pan方向和tilt方向控制量跟蹤曲線，對攝像頭進行離線目標控制位置跟蹤試驗?，F(xiàn)場照片，如圖10所示。

圖10 現(xiàn)場實驗Fig.10 The Field Experiment

實驗條件，如表3所示。

表3 實驗條件信息Tab.3 The Information of Experimental Condition

表3中位置反饋命令平均應(yīng)答時間t1指從發(fā)出命令到接收到位置信息時間，速度控制命令應(yīng)答時間t2指從發(fā)出命令到攝像機開始動作時間，t1和t2由實際測試過程多組值取平均值所得?？紤]到圖像分辨率越大會影響圖像傳輸速率，在不影響圖片質(zhì)量的前提下選擇圖像分辨率為（640×480）。

由于PTZ攝像機視場較寬，短距離內(nèi)的巡檢無法檢驗其跟蹤能力，因此設(shè)定機器人在越過直線塔防震錘后行走15m直線段過程中對防震錘進行動態(tài)跟蹤，此過程中定位坐標采樣時間T=200ms，測試其跟蹤效果。實驗過程包括使用Fuzzy PID帶死區(qū)和不帶死區(qū)的Fuzzy PID的兩種方法進行跟蹤實驗，試驗過程中記錄目標位置變化曲線、攝像機實際跟蹤曲線和速度控制等級變化曲線，主要對比目標跟蹤的連續(xù)性和穩(wěn)定。

由圖11～圖14可以看出：（1）在模糊PID控制中，對比帶死區(qū)和不帶死區(qū)兩種控制結(jié)果：從跟蹤曲線可以看出，當攝像機反饋角度位置與給定目標位置偏差較小時，在Pan方向和Tilt方向上攝像機控制等級均處于等級1，對于設(shè)置死區(qū)的控制器，當位置誤差進入死區(qū)后，計算得到控制等級為0，攝像機接收Move=stop，motor命令，保持當前位置狀態(tài)不變，可有效地減少由于無死區(qū)的控制動作過于頻繁帶來的圖像晃動和機械震動。（2）如圖11 所示，Pan方向目標位置角度在逐漸增加，當保持當前位置狀態(tài)一段時間后，偏差會逐漸增加，最終脫離死區(qū)，控制等級如圖12所示發(fā)生突變，因此將目標跟蹤過程中拍攝圖片時間選定在死區(qū)范圍內(nèi)，以避免旋轉(zhuǎn)運動模糊對圖像的影響。（3）Pan方向角度范圍變化相對于Tilt方向?qū)?，對視角整體影響較大，而Tilt方向趨于平穩(wěn)，死區(qū)在對Tilt方向上的控制影響更為明顯。

圖11 Pan方向Fuzzy PID控制跟蹤曲線Fig.11 Fuzzy PID Control Tracking Curve of Pan Direction

圖12 Pan方向Fuzzy PID控制等級曲線Fig.12 Fuzzy PID Control Grade Curve of Pan Direction

圖13 Tilt方向Fuzzy PID控制跟蹤曲線Fig.13 Fuzzy PID Control Tracking Curve of Tilt Direction

圖14 Tilt方向Fuzzy PID控制等級曲線Fig.14 Fuzzy PID Control Grade Curve of Tilt Direction

6 結(jié)論

機器人在通過PTZ攝像機主動跟蹤目標過程中根據(jù)目標位置不斷調(diào)整姿態(tài)，但由于目標位置隨時發(fā)生變化和攝像機控制精度有限等問題導(dǎo)致視場不穩(wěn)定和振蕩，文中提出了一種帶死區(qū)的模糊PID控制方法，基于架空高壓輸電線巡檢機器人搭建PTZ攝像頭主動視覺跟蹤平臺，對桿塔目標物進行主動跟蹤。實驗表明該方法可以有效降低視場頻繁振蕩，滿足目標跟蹤需求。