高速繩牽引攝像機器人的運動穩(wěn)定控制

韋慧玲,仇原鷹,盛 英

(西安電子科技大學(xué)電子裝備結(jié)構(gòu)設(shè)計教育部重點實驗室,陜西西安 710071)

高速繩牽引攝像機器人的運動穩(wěn)定控制

韋慧玲,仇原鷹,盛 英

(西安電子科技大學(xué)電子裝備結(jié)構(gòu)設(shè)計教育部重點實驗室,陜西西安 710071)

針對大柔度繩索牽引攝像機器人難以實現(xiàn)高速穩(wěn)定運動的難題,提出了一種運動穩(wěn)定控制方法.首先建立動力學(xué)模型,進而規(guī)劃了能夠反映攝像機器人對高機動性目標(biāo)穩(wěn)定跟蹤的軌跡,并對軌跡進行了高階多項式插值以提高攝像機平臺啟停運動的平穩(wěn)性.然后,設(shè)計了基于末端位置空間的比例微分前饋控制器和干擾觀測器組成的混合控制器以實現(xiàn)運動的穩(wěn)定控制.最后進行了攝像機器人快速變向運動的數(shù)值仿真分析.

攝像機器人;動力學(xué);軌跡規(guī)劃;機動跟蹤;穩(wěn)定性

繩牽引并聯(lián)機器人是將驅(qū)動器的運動和力以繩索為媒介并轉(zhuǎn)換成末端執(zhí)行器運動和力的并聯(lián)結(jié)構(gòu)形式機器人.其具有結(jié)構(gòu)簡單、工作空間大、運動支鏈慣性小、運動速度快等優(yōu)點[1],已出現(xiàn)并應(yīng)用于患者康復(fù)、物料搬運、運動模擬、天文觀測等領(lǐng)域[2-5],極大地擴展了機器人的應(yīng)用范圍.近年來,借助于繩牽引并聯(lián)攝像機器人可完美地實現(xiàn)電視轉(zhuǎn)播過程中大范圍全景拍攝的要求[6].但由于柔索只能單向承載,出現(xiàn)振動后難以抑制等原因,要實現(xiàn)繩牽引攝像機器人平穩(wěn)靈活啟動和快速換向運動是一項具有挑戰(zhàn)性的工作.

目前,已有一些學(xué)者對繩牽引攝像機器人開展了研究,并取得一定的成果.文獻[7]設(shè)計了一種應(yīng)用于工業(yè)環(huán)境中的繩牽引攝像機器人,通過采用帶比例積分(Proportional Integral,PI)控制器的速度閉環(huán)反饋控制實現(xiàn)了攝像機平臺在規(guī)劃軌跡上跟蹤誤差最小.但其只能完成速度為0.15 m/s的低速運動,對高速高機動的目標(biāo)跟蹤沒有展開討論,且3根繩索工作空間無法覆蓋田徑運動場、演出現(xiàn)場等矩形場地.文獻[8]設(shè)計了一種與攝像機器人結(jié)構(gòu)類似、用于環(huán)境監(jiān)測的4根繩索牽引的傳感器機器人,其基于松弛變量,采用線性規(guī)劃求解方法,實現(xiàn)對繩索張力分配的優(yōu)化求解.采用增量位移方法對傳感器平臺進行定位,使機構(gòu)完成自標(biāo)定的工作;采用最小二乘漂移檢測算法,使系統(tǒng)能夠?qū)﹂L期漂移進行自檢,保證傳感器在長時間工作過程中的準(zhǔn)確定位[9-10].但該傳感器系統(tǒng)的質(zhì)量(5 kg)相對于攝像機器人平臺系統(tǒng)(25 kg)較輕,在相同加速度下,其系統(tǒng)慣性力比攝像機平臺小,面臨的機動性問題不明顯.文獻[11]通過有限元方法把繩索離散化,建立了攝像機器人的動力學(xué)分析,基于該模型設(shè)計出一種有效抑制繩索振動的控制器,但其研究對象是緩慢運行的非冗余驅(qū)動機構(gòu),故其只考慮了低速運動狀態(tài),未涉及高速運動分析.文獻[12]基于最小索拉力以及拉力最小的繩索與水平面夾角正切值建立了力位混合穩(wěn)定性評價指標(biāo),分析了繩牽引攝像機器人的穩(wěn)定性,但只研究了攝像機器人的結(jié)構(gòu)穩(wěn)定性,未涉及運動穩(wěn)定性的分析.文獻[13]通過考慮繩索質(zhì)量以及慣性影響對高速攝像機器人展開張力優(yōu)化研究,并分析了繩索張力求解的快速性和連續(xù)性,但未涉及穩(wěn)定性方面的分析.文獻[14]基于集合理論獲得了攝像機器人的動力工作空間,但未對動力工作空間內(nèi)的末端執(zhí)行器的穩(wěn)定運行進行分析.文獻[15]采用三次樣條圓弧插補的方法對攝像機器人進行軌跡光滑處理,但其規(guī)定了末端執(zhí)行器在恒定速度下運行,未分析攝像機器人的高機動性[15].

繩牽引攝像機器人在做大范圍空間運動過程中末端執(zhí)行器運動隨拍攝目標(biāo)的高速機動變化而改變,這就對繩牽引攝像機器人的最大加速度、上升時間、運動變向響應(yīng)時間等機動性指標(biāo)提出了更高的要求.因此,筆者針對攝像機器人對高速高機動性的目標(biāo)進行軌跡穩(wěn)定跟蹤的問題展開探討.通過牛頓-歐拉法建立繩牽引并聯(lián)機器人的動力學(xué)模型,進而對啟停變向階段的加速度過大引起的跳動導(dǎo)致軌跡不光滑連續(xù)現(xiàn)象進行高階多項式插值規(guī)劃.根據(jù)系統(tǒng)的繩索單向受力特性、冗余驅(qū)動性以及高速機動運動特性,提出帶有干擾觀測器的基于末端位置空間的比例微分(Proportional Derivative,PD)前饋控制策略,并證明其穩(wěn)定性和一致連續(xù)性.最后通過4索3自由度的攝像機器人仿真說明其穩(wěn)定機動跟蹤效果.

1　動力學(xué)分析

1.1末端執(zhí)行器的動力學(xué)模型

如圖1所示,建立與大地固連的全局坐標(biāo)系O-XYZ和固結(jié)與末端執(zhí)行器質(zhì)心的局部坐標(biāo)系p-xyz,從局部坐標(biāo)系到全局坐標(biāo)系的旋轉(zhuǎn)變化矩陣為O?p.pAi為局部坐標(biāo)系p-x yz中繩與末端執(zhí)行器鉸接點Ai的位置矢量.對于由m根繩牽引的n自由度完全約束繩牽引并聯(lián)機器人(m=n+1),利用牛頓-歐拉法推導(dǎo)出末端執(zhí)行器的動力學(xué)方程為

圖1　攝像機器人結(jié)構(gòu)示意圖

其中,M(X)為動力學(xué)方程質(zhì)量相關(guān)矩陣,¨X為末端執(zhí)行器加速度向量,N(X)為動力學(xué)方程速度相關(guān)矩陣為末端執(zhí)行器速度向量,We為末端執(zhí)行器外力旋量向量,Wg為末端執(zhí)行器廣義重力向量,J為結(jié)構(gòu)矩陣,T是索力矢量.

進一步整理式(2),得

其中,G(X)為力相關(guān)矩陣.至此,就得到了末端執(zhí)行器的動力學(xué)模型的矩陣形式.

1.2驅(qū)動器的動力學(xué)模型

繩牽引并聯(lián)機器人的驅(qū)動器包括電機、減速器以及絞盤.驅(qū)動器的動力學(xué)方程可表示[16]為

其中,A是慣量矩陣,C是粘性摩擦系數(shù)矩陣,r是絞盤的半徑,θ是電機的轉(zhuǎn)角,τ是電機的轉(zhuǎn)矩.

1.3系統(tǒng)的動力學(xué)模型

當(dāng)電機轉(zhuǎn)角為θ時,引起繩索的長度變化量為ΔL,故有繩長與電機轉(zhuǎn)角的關(guān)系式為

通過對上式進行微分,得

聯(lián)立式(3)～(4)及式(6),得到系統(tǒng)的動力學(xué)模型為

進一步整理,得

2　啟停變向過渡規(guī)劃

攝像機器人的軌跡是指攝像機平臺運動的位姿、速度和加速度的時間歷程.軌跡規(guī)劃是指根據(jù)機器人的工作任務(wù)要求,對攝像機平臺的空間運動進行設(shè)計,使之能夠從初始狀態(tài)沿著期望的軌跡運動到終了狀態(tài)[17].為了實現(xiàn)攝像機器人能夠進行連續(xù)光滑的平穩(wěn)跟蹤拍攝,所規(guī)劃的軌跡包含對運動速度和加速度的合理安排.

若對攝像平臺不進行運動規(guī)劃,則運動啟動、變向以及運動結(jié)束產(chǎn)生的瞬間加速度過大,導(dǎo)致繩索出現(xiàn)跳動,攝像機器人不能夠正常工作.由于攝像機器人在跟蹤拍攝過程中機動性很高,因此對軌跡要求比較嚴(yán)格,并且啟停變向時對末端執(zhí)行器的速度、加速度、繩索張力等都有一定的要求,需要更高階的多項式對軌跡進行插值,才能夠滿足需要.為了消除啟停變向過渡階段由于加速度過大引起的跳動導(dǎo)致軌跡不光滑連續(xù)現(xiàn)象,筆者采用高階多項式插值對運動軌跡進行啟停過渡規(guī)劃.

設(shè)當(dāng)t0時末端執(zhí)行器啟動速度值為v(t0),當(dāng)tf時終止速度值為v(tf).為了保證在整個t0～tf時間段內(nèi)速度、加速度、索力等連續(xù)光滑,對t0～tf內(nèi)的軌跡進行高階五次多項式插值,即[17]

多項式的系數(shù)滿足以下6個約束條件:

式(10)中,S0,Sf分別是起始點和終止點的位置;分別是起始點和終止點的速度;分別是起始點和終止點的加速度.因此,在t0=0時,上述線性方程組的解為

3　機動跟蹤控制策略

在實際運用中,由于攝像機器人易受到軌跡突變、風(fēng)荷等外界干擾的影響,這些因素都限制了攝像機器人控制精度的提高.為了解決上述問題,將設(shè)計過程分為性能設(shè)計和干擾抑制設(shè)計兩部分,組成一種混合控制策略.其控制器由基于末端位置空間的PD前饋控制器和干擾觀測器組成,如圖2所示,其中d表示外界擾動,Gn(s)為直流電機名義模型,Q(s)為低通濾波器.

圖2　混合控制系統(tǒng)結(jié)構(gòu)圖

根據(jù)圖2,混合控制器的控制規(guī)律如下:

其中,τ1是基于末端位置空間的PD前饋控制器的控制律,τ2是干擾觀測器的補償控制律.

3.1PD修正前饋控制器設(shè)計

假設(shè)期望的位姿為Xd,基于末端位置空間的PD修正前饋控制規(guī)則的控制律如下:

其中,Kp、Kd是反饋增益矩陣;J?表示JT的廣義逆,J?=J(JTJ)-1;e=Xd-X,是誤差;Q是JT的零基底空間向量,滿足JTQ=0,其作用是在繩子間產(chǎn)生內(nèi)力,保證繩子時刻處于張緊狀態(tài).

3.2干擾觀測器的設(shè)計

干擾觀測器是將系統(tǒng)外部干擾、模型參數(shù)變化等干擾等效到控制器的輸入端,并在控制中引入等價的補償以實現(xiàn)對干擾的完全抑制.筆者將攝像機器人的軌跡突變、風(fēng)荷、測量噪聲等外界擾動視為一個廣義的干擾量,應(yīng)用干擾觀測器對其進行觀測,并在控制的輸入端進行補償抑制.

攝像機器人在跟蹤拍攝過程中受到啟停、變向、風(fēng)荷等的作用,通過繩索傳遞到驅(qū)動單元,使電機負載發(fā)生變化.變化的部分作為,電機所受的外部擾動,用d表示f為等效干擾d的估計值.Gn(s)為直流電機名義模型,Q(s)為低通濾波器,根據(jù)筆者提出的驅(qū)動系統(tǒng)的動力學(xué)模型采用三階低通濾波器[18].干擾觀測器的控制輸出為

3.3穩(wěn)定性分析

由于低通濾波器Q(s)既要抑制擾動,又要消除噪聲影響并保證干擾觀測器的魯棒穩(wěn)定,故其為設(shè)計的關(guān)鍵環(huán)節(jié).根據(jù)魯棒穩(wěn)定性定理,干擾觀測器Q(s)魯棒穩(wěn)定的充分條件[18]是,其中Δ(s)=(Gp(s)-Gn(s))Gn(s),Gp(s)是驅(qū)動系統(tǒng)的實際模型.綜合魯棒性和抗干擾能力的分析,考慮驅(qū)動系統(tǒng)的動力學(xué),采用三階低通濾波器,即Q(s)=(3ψs+1)(ψ3s3+3ψ2s2+3ψs+1),其中根據(jù)Δ(s)與不同帶寬Q(s)的幅頻特性確定ψ值,s是拉普拉斯變換中的s域.

根據(jù)系統(tǒng)的總能量,并結(jié)合式(13)構(gòu)造如下的李雅普諾夫函數(shù)[19]:

式(15)對時間的全導(dǎo)數(shù)表示為

將式(13)代入式(16),得

3.4一致連續(xù)性證明

下面根據(jù)Barbalat’s引理[21]完成漸進穩(wěn)定性的證明.首先證明的一致連續(xù)性,對其進行求導(dǎo),得

4　仿真分析

4.1仿真參數(shù)設(shè)置

為了驗證高階多項式,對攝像機器人啟停變向軌跡插值規(guī)劃后的跟蹤平穩(wěn)性進行了數(shù)值仿真.攝像機器人是由4根繩索牽引、3平動自由度的完全約束冗余驅(qū)動系統(tǒng).

以1號塔柱為全局坐標(biāo)系原點,攝像機器人的數(shù)值仿真參數(shù)為:1#滑輪位置坐標(biāo)A1=[0,0,25]T,2#滑輪位置坐標(biāo)A2=[39,0,25]T,3#滑輪位置坐標(biāo)A3=[39,42,25]T,4#滑輪位置坐標(biāo)A4=[0,42,25]T.末端執(zhí)行器動平臺質(zhì)量mp=20 kg;繩索的最小破斷拉力Tmax=3 000 N,最小預(yù)緊力Tmin=10 N.電機的額定輸出力矩τmax=15.8 N·m,τmin=-15.8 N·m,等效到電機軸的轉(zhuǎn)動慣量為7.52×10-4kg·m2,等效粘性阻尼系數(shù)為1.88×10-4N·m·s,絞盤半徑r=0.04 m.在仿真過程中,運行時間t1=10 s,t2=5 s,t3= 5 s,共20 s,微分方程的數(shù)值求解采用四階龍格庫塔方法.控制參數(shù)Kp和Kd根據(jù)經(jīng)驗試湊法和現(xiàn)場調(diào)試確定[18],Kp=8.5 diag(1,1,1,1),Kd=1.5 diag(1,1,1,1).外界干擾采用隨機風(fēng)荷模擬[22].

任取工作空間內(nèi)3點為空間三角形軌跡的3個頂點,令攝像機器人的末端執(zhí)行器從起點沿著三角形軌跡運行一周,驗證啟停變向規(guī)劃的合理性和跟蹤平穩(wěn)性.三角形的3個頂點為p1=[10,10,5]T,p2=[30,25,10]T,p3=[20,20,15]T.為了保證啟停平穩(wěn),假設(shè)

4.2仿真結(jié)果與分析

對末端執(zhí)行器的啟停變向過渡進行高階插值規(guī)劃后,繩索特性如圖3所示.圖3(a)是繩索張力在整個運行過程中的變化情況.在整個運動過程中索力是連續(xù)變化的,但在變向點有停頓,這是由于在三角形軌跡的拐點處,末端執(zhí)行器必須使其速度減為零以避免在該點處產(chǎn)生跳動.從圖3(b)可以看出,繩索長度變化連續(xù)光滑,在t=10 s時,第1次變向;在t=15 s時,第2次變向.這兩次變向繩索都沒有發(fā)生抖動現(xiàn)象,而是平緩過渡,說明在變向時末端執(zhí)行器沒有晃動.

圖4是啟停變向過渡規(guī)劃后末端執(zhí)行器的運動特性.從圖上可以看出,在整個運行過程中,末端執(zhí)行器的速度、加速度以及軌跡都是連續(xù)光滑,在變向點處未出現(xiàn)抖動現(xiàn)象.從圖4(a)上看,在變向點t=10 s和t=15 s的左右,兩邊合速度曲線變化規(guī)律是先上升后下降;在時間分界點降為0時,實現(xiàn)了變向時速度平滑過渡.說明了高階插值規(guī)劃是合理有效的.從圖4(b)啟動和變向局部放大圖可知,在t=0 s(啟動)和t=10 s (第1次變向)時,加速度沒有無限增大而是接近于零,說明變向時加速度不會突變.合加速度曲線在3條邊的3個中點,即5.0 s、12.5 s和17.5 s時都取零值,這是由于運動規(guī)劃使得末端在3條邊上運行時,都是前半程加速,后半程減速.圖4(c)是沒有對空間三角形軌跡進行高階插值規(guī)劃的軌跡跟蹤水平投影情況.由圖可知,在變向處跟蹤軌跡出現(xiàn)了突變,沒有達到連續(xù)光滑的跟蹤,且跟蹤誤差明顯比高階插值規(guī)劃后(圖4(d))的跟蹤誤差大.未規(guī)劃時兩個變向處的軌跡跟蹤誤差分別為0.113 8 m和0.111 1 m,而規(guī)劃后變向處跟蹤誤差分布為0.012 9 m和0.015 9 m.圖4(d)是對空間三角形軌跡進行高階插值規(guī)劃后的軌跡跟蹤水平投影情況.從圖4(d)可知,在第1次和第2次變向時,軌跡沒有突變,而是以較小的跟蹤誤差順利過渡,說明了插值規(guī)劃后末端執(zhí)行器實現(xiàn)了軌跡的連續(xù)光滑,這有利于高速運動和減少末端執(zhí)行器的振動.從圖4(d)還知,即使對啟停變向過渡階段進行了軌跡規(guī)劃,但由于繩索自身振動仍導(dǎo)致了末端執(zhí)行器少量跟蹤抖動誤差.

圖3　啟停變向過渡規(guī)劃后的繩索特性

圖4　啟停變向過渡規(guī)劃后末端執(zhí)行器的運動特性

運用PD前饋控制策略與帶有干擾觀測器的PD前饋控制策略對高階插值規(guī)劃后的空間三角形軌跡進行跟蹤,其位置跟蹤誤差如圖5所示.從圖可知,帶有干擾觀測器的PD前饋控制的跟蹤誤差比PD前饋控制的跟蹤誤差小,跟蹤誤差峰值相差約為0.02 m,均值相差約為0.11 m.說明了干擾觀測器能很好地抑制外界擾動,提高運行的平穩(wěn)性.圖6是低通濾波器輸入信號與輸出信號的對比.從圖可知,濾波器有效地去除了測量噪聲.在10 s后輸出信號-f趨于一個平穩(wěn)值,說明干擾觀測器是魯棒穩(wěn)定的.因此,低通濾波器Q(s)的設(shè)計是合理有效的.

圖5　有無干擾觀測器的PD前饋控制跟蹤誤差對比

圖6　低通濾波器前后信號

5　結(jié) 論

(1)針對繩索單向受力特性的繩牽引并聯(lián)機器人的結(jié)構(gòu)特點,分別建立了基于牛頓-歐拉法的末端執(zhí)行器的動力學(xué)模型和驅(qū)動系統(tǒng)的動力學(xué)模型,最后獲得繩牽引并聯(lián)機器人動力學(xué)模型.

(2)為了抑制啟停變向過渡階段由于加速度突變引起的末端執(zhí)行器軌跡的抖動,采用高階多項式插值方法對繩牽引并聯(lián)機器人機動運行過程中的啟停變向過渡階段進行插值規(guī)劃,提高其機動跟蹤的平穩(wěn)性.

(3)針對繩索單向受力、高速機動性以及冗余驅(qū)動等特點,以軌跡控制為目標(biāo),通過設(shè)計帶有干擾觀測器的基于末端位置空間的PD前饋控制策略,達到了抑制繩牽引并聯(lián)機器人在機動跟蹤時由于風(fēng)荷等引起的擾動,并且驗證了該控制規(guī)律的穩(wěn)定性和一致連續(xù)性.

(4)以4索3自由度冗余驅(qū)動并聯(lián)攝像機器人沿著空間三角形軌跡運行一周為例,驗證了啟停變向插值規(guī)劃的合理性和跟蹤平穩(wěn)性.高階多項式插值規(guī)劃后末端執(zhí)行器在機動運行過程中索力、索長、軌跡、速度以及加速度等連續(xù).干擾觀測器能夠有效地抑制外界擾動,提高運行平穩(wěn)性.

[1]TANG X Q.An Overview of the Development for Cable-driven Parallel Manipulator[J].Advances in Mechanical Engineering,2014:823028.

[2]JIN X J,JUN D,JIN X M,et al.Upper Limb Rehabilitation Using a Planar Cable-driven Parallel Robot with Various Rehabilitation Strategies[C]//Mechanisms and Machine Science:32.Berlin:Springer,2015:307-321.

[3]COLLARD J F,RIEHL N,BARADAT C.Geometry Selection of a Redundantly Actuated Cable-suspended Parallel Robot[J].IEEE Transactions on Robotics,2015,2(31):501-510.

[4]DOUADI L,SPINELLO D,GUEAIEB W,et al.Planar Kinematics Analysis of a Snake-like Robot[J].Robotica,2014,32(5):659-675.

[5]ZI B,DUAN B Y,DU J L,et al.Dynamic Modeling and Active Control of a Cable-suspended Parallel Robot[J]. Mechatronics,2008,18(1):1-12.

[6]VINCENT T L.Stabilization for Film and Broadcast Cameras[J].IEEE Control Systems Magazine,2008,28(1): 20-21.

[7]GORDIEVSKY V.Design and Control of a Robotic Cable-suspended Camera System for Operation in 3-D Industrial Environment[D].Cambridge:Massachusetts Institute of Technology,2008.

[8]BORGSTROM P L,BORGSTROM N P,STEALEY M J,et al.Design and Implementation of NIMS3D,a 3-D Cabled Robot for Actuated Sensing Applications[J].IEEE Transactions on Robotics,2009,25(2):325-339.

[9]BORGSTROM P H,JORDAN B L,BORGSTROM B J,et al.NIMS-PL:a Cable-driven Robot with Self-calibration Capabilities[J].IEEE Transactions on Robotics,2009,25(5):1005-1015.

[10]BORGSTROM P H,JORDAN B L,SUKHATME G S,et al.Rapid Computation of Optimally Safe Tension Distributions for Parallel Cable-driven Robots[J].IEEE Transactions on Robotics,2009,25(6):1271-1281.

[11]DU J L,AGRAWAL S K.Dynamic Modeling of Cable-driven Parallel Manipulators with Distributed Mass Flexible Cables[J].Journal of Vibration and Acoustics,2015,137:1-8.

[12]劉鵬,仇原鷹.繩牽引攝像機器人的力位混合穩(wěn)定性評價方法[J].西安電子科技大學(xué)學(xué)報,2016,43(1):100-106. LIU Peng,QIU Yuanying.Approach with a Hybrid Force-position Property to Assessing the Stability for Camera Robots[J].Journal of Xidian University,2016,43(1):100-106.

[13]SU Y,QIU Y Y,LIU P.The Continuity and Real-time Performance of the Cable Tension Determining for a Suspend Cable-driven Parallel Camera Robot[J].Advanced Robotics,2015,29(12):743-752.

[14]于亮亮,仇原鷹,蘇宇.高速柔索牽引攝像機器人動力工作空間研究[J].工程力學(xué),2013,11(30):245-250. YU Liangliang,QIU Yuanying,SU Yu.Dynamic Workspace of a High-speed Cable-driven Camera Robot[J]. Engineering Mechanics,2013,11(30):245-250.

[15]仲志丹,黨國輝,王冰雪,等.三平動繩牽引并聯(lián)機器人軌跡預(yù)處理算法[J].計算機測量與控制,2014,22(9): 2826-2859. ZHONG Zhidan,DANG Guohui,WANG Bingxue,et al.Three Translational Parallel Robot Trajectory Rope Pulling Preprocessing Algorithm[J].Computer Measurement&Control,2014,22(9):2826-2859.

[16]KORAYEM M H,TAGHIRAD H D,BAMDAD M.Dynamic Load Carrying Capacity of Flexible Cable Suspended Robot:Robust Feedback Linearization Control Approach[J].Journal of International&Robotic Systems,2010,60(3/ 4):341-363.

[17]蔡自興.機器人學(xué)基礎(chǔ)[M].北京:機械工業(yè)出版社,2009.

[18]劉金琨.先進PID控制及其MATLAB仿真[M].北京:電子工業(yè)出版社,2003.

[19]ARIMOTO S.Control Theory of Non-linear Mechanical Systems[M].Oxford:Clarendon Press,1996.

[20]LEWIS F L,DAWSON D M,ABDALLAH C T.Robot Manipulator Control:Theory and Practice[M].New York: Marcel Dekker,2004.

[21]SLOTINE J J E,LI W P.Applied Nonlinear Control[M].Upper Saddle River:Prentice Hall,1991.

[22]QIU Y Y,DUAN B Y,WEI Q.Optimal Distribution of the Cable Tensions and Structural Vibration Control of the Cable-cabin Flexible Structure[J].Structural Engineering and Mechanics,2002,14(1):39-56.

(編輯:郭 華)

Motion stable control for cable-driven parallel camera robots with high speeds

WEI Huiling,QIU Yuanying,SHENG Ying
(Ministry of Education Key Lab.of Electronic Equipment Structure,Xidian Univ.,Xi’an 710071,China)

A method for motion stability control is proposed on the problem that it is difficult for the camera robot to achieve the high speed and steady movement.First,the dynamic model is established. Then,the trajectory of the camera robot to the stable tracking of high maneuverability target is planned. And,high order polynomial interpolation is performed to improve the stability of the start and stop motion for the camera platform.Furthermore,a hybrid controller based on the PD feed forward controller and disturbance observer is designed in order to achieve stable motion.Finally,the rapid turning motion is discussed by numerical simulation,and the validity of the proposed method is verified.

camera robots;dynamics;trajectory planning;maneuver tracking;stability

TP242

A

1001-2400(2016)05-0063-07

10.3969/j.issn.1001-2400.2016.05.012

2015-07-20 網(wǎng)絡(luò)出版時間:2015-12-10

國家自然科學(xué)基金資助項目(51175397)

韋慧玲(1986-),女,西安電子科技大學(xué)博士研究生,E-mail:weihuiling2007@126.com.

網(wǎng)絡(luò)出版地址:http://www.cnki.net/kcms/detail/61.1076.TN.20151210.1529.024.html