VGT空間機(jī)械臂地面懸吊系統(tǒng)二自由度控制*

馮文婉，楊永勝，胡士強(qiáng)

(上海交通大學(xué)，上海200240)

VGT空間機(jī)械臂地面懸吊系統(tǒng)二自由度控制*

馮文婉，楊永勝，胡士強(qiáng)

(上海交通大學(xué)，上海200240)

為了在地表環(huán)境下對多節(jié)雙八面體變幾何桁架空間機(jī)械臂進(jìn)行空間環(huán)境模擬研究，需要把機(jī)械臂懸吊起來進(jìn)行重力補(bǔ)償.根據(jù)機(jī)械臂的正向運(yùn)動(dòng)學(xué)和張力吊掛原理，設(shè)計(jì)了懸吊系統(tǒng)二自由度控制器.該控制器其中一個(gè)自由度由機(jī)械臂的正向運(yùn)動(dòng)學(xué)得出前饋控制信號，另一個(gè)自由度根據(jù)張力的偏移信號，采用PI控制得出反饋控制信號，結(jié)合兩個(gè)自由度的信號對吊索長度進(jìn)行收放控制，從而使吊索保持恒定張力.實(shí)驗(yàn)表明，該控制器能快速、穩(wěn)定、可靠地控制機(jī)械臂吊索張力，既能補(bǔ)償前饋控制無法消除的結(jié)構(gòu)誤差，又能解決反饋控制響應(yīng)過慢的問題，控制性能遠(yuǎn)遠(yuǎn)優(yōu)于單自由度控制.

空間機(jī)械臂;多吊索懸吊系統(tǒng);二自由度控制;重力補(bǔ)償

0 引言

變幾何桁架(variable geometry truss，VGT)機(jī)械臂是一種具廣泛應(yīng)用前景的機(jī)械臂，其中一類由多節(jié)雙八面體VGT連接而成的機(jī)械臂因其剛度大、載荷比大、定位精度高、可伸縮等特點(diǎn)被考慮作為一種空間機(jī)械臂受到越來越多的研究［1-6］.而空間機(jī)械臂是應(yīng)用于太空環(huán)境的，其設(shè)計(jì)并沒有把重力因素考慮進(jìn)去，因此，為了在地表環(huán)境下對機(jī)械臂進(jìn)行空間環(huán)境模擬研究，需要進(jìn)行重力補(bǔ)償.

地面重力補(bǔ)償法有落塔法、拋物飛行法、水浮法、氣懸浮法和懸吊法［7］.懸吊法結(jié)構(gòu)簡單、比較易于實(shí)現(xiàn)且可進(jìn)行三維空間模擬，所以應(yīng)用較為廣泛.懸吊法又分為主動(dòng)式和被動(dòng)式:主動(dòng)式是采用伺服控制系統(tǒng)主動(dòng)地調(diào)節(jié)繩索拉力;被動(dòng)式是通過配重物被動(dòng)地跟隨懸掛物運(yùn)動(dòng).被動(dòng)式的不足是引入了附加質(zhì)量和摩擦干擾，而主動(dòng)式則能克服這些問題，具有更高的補(bǔ)償精度.日本富士通實(shí)驗(yàn)室通過建立拉力傳感器輸出和電機(jī)電流的關(guān)系，用PID控制律控制電機(jī)電流，從而達(dá)到力的恒定控制［8］.美國卡耐基梅隆大學(xué)研制的SM2空間機(jī)械臂采用的是主被動(dòng)結(jié)合的懸吊式微重力補(bǔ)償系統(tǒng)［9］:在水平方向上根據(jù)角傳感器的實(shí)測反饋量用PD控制得出水平移動(dòng)量，主動(dòng)地使吊絲保持豎直;垂直方向用被動(dòng)式.而后同屬卡耐基梅隆大學(xué)機(jī)器人研究所的White等［10］提出在垂直方向上運(yùn)用模糊PI控制的主動(dòng)式重力補(bǔ)償方法.近年來的重力補(bǔ)償研究集中在機(jī)械設(shè)計(jì)上，關(guān)于力的控制都是通過簡單的力差判斷來控制繩索的收放［11-12］.

以上主動(dòng)式懸吊法中的伺服機(jī)構(gòu)都是采用力矩電機(jī)，通過力的反饋信號控制電機(jī)電流從而使電機(jī)的輸出力矩滿足期望.但是這種單純的力反饋控制的主動(dòng)式懸吊法存在一個(gè)問題:由于機(jī)械臂和懸吊系統(tǒng)間存在耦合，可能使整個(gè)系統(tǒng)不穩(wěn)定.對于多節(jié)雙八面體VGT機(jī)械臂，其結(jié)構(gòu)以及結(jié)構(gòu)間隙、柔性的存在使得系統(tǒng)有著較強(qiáng)的非線性，而且多個(gè)吊點(diǎn)間也存在耦合，整個(gè)懸吊系統(tǒng)是個(gè)多輸入多輸出耦合系統(tǒng)，所以傳統(tǒng)的方法是不可行的.

針對多節(jié)VGT一類機(jī)械臂的重力補(bǔ)償，本文提出二自由度控制主動(dòng)式懸吊法:一個(gè)自由度是前饋，根據(jù)機(jī)械臂的正向運(yùn)動(dòng)學(xué)得出前饋控制信號;另一個(gè)自由度是反饋，根據(jù)張力的偏移信號，采用PI控制得出反饋控制信號;結(jié)合兩個(gè)自由度的信號對吊索長度進(jìn)行收放控制，使吊索拉力保持恒定.該方法依靠前饋控制一方面能有效地減少被控量的動(dòng)態(tài)偏差，另一方面能對反饋控制起到一定程度的解耦作用;依靠反饋控制能補(bǔ)償因機(jī)械臂結(jié)構(gòu)誤差等系統(tǒng)誤差引起的前饋控制無法補(bǔ)償?shù)膹埩Σ?

1 懸吊法二自由度控制系統(tǒng)結(jié)構(gòu)

1.1 懸吊系統(tǒng)運(yùn)作過程描述

懸吊系統(tǒng)的結(jié)構(gòu)設(shè)計(jì)如圖1(a)所示，圖1(b)為實(shí)驗(yàn)現(xiàn)場圖.吊點(diǎn)設(shè)置在機(jī)械臂每一節(jié)的末端平臺的端點(diǎn)上，懸吊系統(tǒng)在x方向上采用位置開環(huán)控制、y方向上被動(dòng)跟蹤吊點(diǎn)，使吊索基本保持豎直，z方向上采用二自由度控制調(diào)節(jié)吊索長度以補(bǔ)償重力.本文主要介紹基于吊索能基本保持豎直的情況下z方向上的二自由度控制器的設(shè)計(jì).

圖1 懸吊系統(tǒng)結(jié)構(gòu)設(shè)計(jì)Fig.1Structure design of suspension system

1.2 懸吊系統(tǒng)二自由度控制原理

控制系統(tǒng)結(jié)構(gòu)如圖2所示，其中:LC為規(guī)劃的機(jī)械臂主動(dòng)桿桿長指令;X1為由機(jī)械臂正向運(yùn)動(dòng)學(xué)解算得出的吊點(diǎn)位置;F為張力傳感器讀數(shù);G為給定恒力;e為張力誤差;X2為PI控制器輸出;XC為懸吊裝置伺服電機(jī)的指令位移;Xm為懸吊裝置伺服電機(jī)的實(shí)際位移;Pa為機(jī)械臂吊點(diǎn)的實(shí)際位置.

圖2 控制系統(tǒng)結(jié)構(gòu)Fig.2Structure of control system

控制原理:一方面，機(jī)械臂主動(dòng)桿桿長LC規(guī)劃好后，把根據(jù)機(jī)械臂正向運(yùn)動(dòng)學(xué)預(yù)測出該指令下的吊點(diǎn)位置X1作為懸吊裝置伺服電機(jī)的前饋指令，另一方面，把由張力傳感器感應(yīng)的吊索張力F與給定恒力G的差值e經(jīng)過PI控制器生成的X2作為反饋指令，前饋指令與反饋指令相加得到電機(jī)的位移指令XC.于是，LC作用在機(jī)械臂上，電機(jī)根據(jù)指令XC產(chǎn)生實(shí)際位移Xm，也作用在機(jī)械臂上，從而機(jī)械臂吊點(diǎn)的實(shí)際位移為Pa，那么Xm與Pa之差就會改變吊索張力，被張力傳感器感應(yīng)形成回路反饋，最后使吊索張力保持為給定恒力.

2 前饋控制器設(shè)計(jì)

前饋控制器是利用機(jī)械臂的正向運(yùn)動(dòng)學(xué)計(jì)算出吊點(diǎn)的位置.如圖3所示，多節(jié)雙八面體VGT機(jī)械臂由多個(gè)雙八面體VGT模塊連接而成，具有模塊化特點(diǎn).每個(gè)模塊由兩個(gè)對稱的八面體桁架結(jié)構(gòu)組合而成，中間的公共平面為驅(qū)動(dòng)平面，兩個(gè)八面體中與驅(qū)動(dòng)平面相對的平面為連接平面.通過改變每個(gè)模塊驅(qū)動(dòng)平面上的驅(qū)動(dòng)器(主動(dòng)桿)的長度L1～L3可以改變模塊的構(gòu)形，從而使機(jī)械臂末端平面位姿發(fā)生變化.機(jī)械臂的正向運(yùn)動(dòng)學(xué)就是由每個(gè)模塊的L1～L3得出末端平面的位姿.

圖3 雙八面體VGT機(jī)械臂Fig.3Double octahedral VGT manipulator

對于第一個(gè)模塊，與固定基座連接的連接平面為底面，與第二個(gè)模塊連接的連接平面為頂面;對于第k(k＞1)個(gè)模塊，定義該模塊與第k－1個(gè)模塊連接的連接平面為底面，另一個(gè)連接平面為頂面.對于第k(k＞0)個(gè)模塊，固定在其底面和頂面的兩個(gè)坐標(biāo)系分別定義為k－1和k坐標(biāo)系，坐標(biāo)系原點(diǎn)在連接平面中心，則O坐標(biāo)系代表固定基座坐標(biāo)系，其原點(diǎn)則為吊點(diǎn)位置坐標(biāo)的原點(diǎn).定義為k坐標(biāo)系相對k－1坐標(biāo)系的旋轉(zhuǎn)矩陣為k－1和k坐標(biāo)系之間的位移矢量Pk在k－1坐標(biāo)系內(nèi)的坐標(biāo)為第k個(gè)模塊的吊點(diǎn)Hk在k坐標(biāo)系下的坐標(biāo)，則有:

多節(jié)雙八面體VGT機(jī)械臂吊點(diǎn)坐標(biāo)的求解問題為:給定每個(gè)模塊主動(dòng)桿L1～L3的長度，根據(jù)式求出每節(jié)模塊的吊點(diǎn)在0坐標(biāo)系下的坐標(biāo)根據(jù)式，只要求出每個(gè)模塊的即可求得而對于每個(gè)模塊，由L1～L3求取和實(shí)際上是單模塊的正向運(yùn)動(dòng)學(xué)問題，該問題的解算已在文獻(xiàn)［1］給出.

3 反饋控制器設(shè)計(jì)

本懸吊系統(tǒng)是多輸入多輸出非線性系統(tǒng)，而基于前饋控制的作用，系統(tǒng)能始終工作在平衡點(diǎn)附近，且系統(tǒng)多通道間的耦合程度大大減弱，模型因此得到解耦線性化，所以反饋控制器的設(shè)計(jì)可基于系統(tǒng)單通道模型.

3.1 系統(tǒng)單通道模型辨識

對于本懸吊系統(tǒng)，每個(gè)通道的模型為單輸入單輸出線性系統(tǒng)，輸入為X2，輸出為F，可近似為一階純滯后模型(FOPDT):

FOPDT模型可采用開環(huán)系統(tǒng)階躍響應(yīng)曲線法進(jìn)行辨識.對某一通道進(jìn)行辨識時(shí)系統(tǒng)設(shè)置如下:

1)前饋控制不作用;

2)機(jī)械臂主動(dòng)桿長度不變;

3)除當(dāng)前辨識的通道外，其它通道輸入信號為零.

得到系統(tǒng)階躍響應(yīng)曲線后，根據(jù)文獻(xiàn)［13］可用兩點(diǎn)法進(jìn)行辨識

式中，f(∞)表示階躍響應(yīng)的穩(wěn)態(tài)值，A表示階躍輸入幅值.

T和L可在表1取兩點(diǎn)，根據(jù)對應(yīng)關(guān)系求出.

表1 標(biāo)準(zhǔn)化的穩(wěn)態(tài)值和時(shí)間t的關(guān)系Tab.1Standardized relationship between stable value and t

3.2 PI控制器設(shè)計(jì)

反饋控制通道結(jié)構(gòu)如圖4所示.

圖4 反饋控制結(jié)構(gòu)Fig.4Structure of feedback control

控制器采用經(jīng)典PI算法，傳遞函數(shù)為

由于控制對象為FOPDT模型，可用Cohen-Coon法［14］對PI控制器參數(shù)進(jìn)行整定.其原理是通過配置系統(tǒng)的主導(dǎo)極點(diǎn)使響應(yīng)曲線按4∶1衰減比衰減，從而得到PI參數(shù)整定規(guī)則

式中，a=K/L，b=L/(T+L).

4 實(shí)驗(yàn)與結(jié)果

4.1 機(jī)械臂懸吊實(shí)驗(yàn)系統(tǒng)

實(shí)驗(yàn)機(jī)械臂為5節(jié)雙八面體VGT加頭部負(fù)載結(jié)構(gòu)，每節(jié)末端一個(gè)吊點(diǎn)加上頭部共6個(gè)吊點(diǎn).

其中，系統(tǒng)使用的張力傳感器為ZZBL-4高精度張力傳感器，量程為50 N.而機(jī)械臂每節(jié)的質(zhì)量為1.5 kg，頭部裝置質(zhì)量也為1.5 kg，根據(jù)吊點(diǎn)分布與質(zhì)量關(guān)系得出的各吊索的給定恒力見表2，可見最大給定恒力為29.4 N，即使加上誤差承受范圍，傳感器量程也滿足使用要求.

表2 各個(gè)吊點(diǎn)的給定恒力Tab.2Constant tension distributed for the cables

電機(jī)采用的是Maxon直流伺服電機(jī)，由電機(jī)DCX22S EB KL 24V、齒輪箱GPX22 A 150:1及編碼器ENX16 EASY 512IMP組合而成.組合電機(jī)輸入直流電壓24V，額定功率9.3 W，最大輸出力矩為1 200 mN·m，根據(jù)結(jié)構(gòu)設(shè)計(jì)要求最大吊點(diǎn)拉力出所需輸出力矩為1 000 mN·m，滿足設(shè)計(jì)需求;最大輸出轉(zhuǎn)速為42 r/min，結(jié)合張力傳感器尺寸，吊索最大收放速度為66 mm/s，而六節(jié)機(jī)械臂吊點(diǎn)的最大速度為65 mm/s，也基本滿足要求.

4.2 系統(tǒng)辨識和反饋控制器設(shè)計(jì)

對第一節(jié)對應(yīng)的通道進(jìn)行模型辨識，首先驗(yàn)證模型的可近似線性性:系統(tǒng)初始位于平衡點(diǎn)，給定該通道伺服電機(jī)的位移指令X2，記錄張力傳感器穩(wěn)態(tài)讀數(shù)F，得到F-X2的關(guān)系見圖5.可見，在平衡點(diǎn)附近，模型可近似線性化.

圖5 張力傳感器讀數(shù)-電機(jī)位移曲線Fig.5F-X2curve

給定電機(jī)階躍輸入x2(t)=1(t)，即對應(yīng)式(2)中，A=1.系統(tǒng)的輸出響應(yīng)曲線見圖6，其中對應(yīng)式(2)中，有f(∞)=19.72－14.7=5.02，于是求得K=5.02.取表1中對應(yīng)28.4%和63.2%的點(diǎn)，則對應(yīng)時(shí)間分別為t1=0.21 s，t2=0.57 s，于是根據(jù)表1，求得:T=1.5(t2－t1)=0.54 s，L=0.5(3t1－t2)=0.03 s.把K、L和T代入式(3)，求得Kp= 3.392，Ti=0.089.

圖6 系統(tǒng)階躍響應(yīng)曲線Fig.6Step response of system

同理，對機(jī)械臂其余各節(jié)對應(yīng)通道辨識后通過整定可得控制參數(shù)見表3.

表3 機(jī)械臂各吊點(diǎn)對應(yīng)控制參數(shù)Tab.3Control variables of corresponding hanging points

4.3 機(jī)械臂運(yùn)動(dòng)過程懸吊實(shí)驗(yàn)系統(tǒng)控制

1)單節(jié)運(yùn)動(dòng)

單自由度控制下機(jī)械臂多節(jié)運(yùn)動(dòng)可控性差，所以安全起見，進(jìn)行機(jī)械臂單節(jié)運(yùn)動(dòng)過程的控制實(shí)驗(yàn)以對比單自由度控制和二自由度控制效果:機(jī)械臂第五節(jié)使動(dòng)作上下運(yùn)動(dòng).吊點(diǎn)的位移和速度曲線可根據(jù)正向運(yùn)動(dòng)學(xué)得出，見圖7.控制參數(shù)按表3選取，其張力控制結(jié)果見圖8.

圖7 第五節(jié)吊點(diǎn)位移和速度曲線Fig.7Displacement and velocity curves of 5thhanging point

圖8 第五節(jié)吊點(diǎn)張力曲線Fig.8Tension curves of 5thhanging point

由圖7和圖8可知，前饋控制能及時(shí)響應(yīng)系統(tǒng)動(dòng)態(tài)誤差，但由于機(jī)械臂結(jié)構(gòu)誤差的存在，張力誤差隨著機(jī)械臂運(yùn)動(dòng)幅度的增大而增大;反饋控制與結(jié)構(gòu)誤差無關(guān)，但是響應(yīng)速度跟不上機(jī)械臂的運(yùn)動(dòng)速度，系統(tǒng)偏離平衡點(diǎn);二自由度控制結(jié)合了前饋控制和反饋控制的優(yōu)點(diǎn)，一方面前饋控制及時(shí)響應(yīng)系統(tǒng)動(dòng)態(tài)誤差，另一方面反饋控制消除結(jié)構(gòu)誤差產(chǎn)生的張力差，其張力差的控制遠(yuǎn)遠(yuǎn)優(yōu)于單自由度的控制.

2)多節(jié)運(yùn)動(dòng)

機(jī)械臂按“抬頭→低頭→水平往左→水平往右”的動(dòng)作順序規(guī)劃各節(jié)主動(dòng)桿桿長，桿的伸長速度為1 mm/s，每個(gè)吊點(diǎn)對應(yīng)的控制參數(shù)按表3設(shè)定.于是，二自由度控制下六個(gè)吊點(diǎn)對應(yīng)的張力控制結(jié)果見圖9和圖10.實(shí)驗(yàn)結(jié)果表明，在所有吊點(diǎn)中最大位移達(dá)到500 mm、最大速度達(dá)到20 mm/s時(shí)，系統(tǒng)最大張力誤差比控制在0.5%以內(nèi)，機(jī)械臂可以順暢完成設(shè)定動(dòng)作，控制性能滿足實(shí)驗(yàn)要求.

圖9 吊點(diǎn)1、2、3數(shù)據(jù)曲線Fig.9Data curves of hanging point 1，2，3

圖10 吊點(diǎn)4、5、6數(shù)據(jù)曲線Fig.10Data curves of hanging point 4，5，6

5 結(jié)論

本文針對多節(jié)VGT一類機(jī)械臂的重力補(bǔ)償提出一種二自由度控制主動(dòng)式懸吊法，通過解決多節(jié)機(jī)械臂正向運(yùn)動(dòng)學(xué)問題設(shè)計(jì)了前饋控制器，通過模型辨識和參數(shù)整定分析設(shè)計(jì)了PI反饋控制器.實(shí)驗(yàn)表明，在二自由度控制下，機(jī)械臂可以以較大速度穩(wěn)定順暢地運(yùn)動(dòng)，運(yùn)動(dòng)過程吊索張力誤差比能控制在0.5%以內(nèi).通過對比，二自由度控制既能補(bǔ)償前饋控制無法消除的結(jié)構(gòu)誤差，又能解決反饋控制響應(yīng)過慢的問題，控制性能遠(yuǎn)遠(yuǎn)優(yōu)于單自由度控制.

［1］WILLIAMS R L.Kinematic modeling of a double octahedral variable geometry truss(VGT)as an extensible gimbal［R］.Hampton:NASA Technical Memorandum 109127，1994.

［2］WILLIAMS R L，Mayhew J B.Control of truss-based manipulators using virtual serial models［C］//ASME Design Technical Conferences.CA:Irvine，1996.

［3］HALL J J，WILLIAMS R L.Case study:inertial measurement unit calibration platform［J］.Journal of Robotic Systems，2000，17(17):623-632.

［4］陳務(wù)軍，付功義，何艷麗，等.八面體桁架單元及其派生系所構(gòu)成的空間伸展臂［J］.上海交通大學(xué)學(xué)報(bào)，2001，35(4):509-513.CHEN W J，F(xiàn)U G Y，HE Y L，et al.Space masts constructed from octahedral truss units and their derivatives［J］.Journal of Shanghai Jiao Tong University，2001，35 (4):509-513.

［5］姜柏森，楊永勝，胡士強(qiáng).八面體變幾何桁架機(jī)器人的運(yùn)動(dòng)學(xué)分析及仿真研究［J］.制造業(yè)自動(dòng)化，2015 (6):20-22.JIANG B S，YANG Y S，HU S Q.The solution and simulation for the kinematic problem of octahedral VGT manipulator［J］.Manufacturing Automation，2015(6): 20-22.

［6］YANG Y，JIANG B，HU S.Fast trajectory planning for VGT manipulator via convex optimization［J］.Advanced Robotic Systems，2015，12(9):136.

［7］齊乃明，張文輝，高九州，等.空間微重力環(huán)境地面模擬試驗(yàn)方法綜述［J］.航天控制，2011，29(3):95-100.QI N M，ZHANG W H，GAO J Z，et al.The primary discussion for the ground simulation system of spatial microgravity［J］.Aerospace Control，2011，29(3):95-100.

［8］SATO Y，EJIRI A，IIDA Y，et al.Micro-G emulation system using constant-tension suspension for a space manipulator［C］//IEEE International Conference on Robotics and Automation.New York:IEEE，1991.

［9］BROWN H B，DOLAN J M.A novel gravity compensation system for space robots［C］//ASCE Speciality conference on Robotics for Challenging Environments.Albuquerque:ASCE，1994:250-258.

［10］WHITE G，XU Y.An active vertical-direction gravity compensation system［J］.Instrumentation＆Measurement IEEE Transactions on，1994，43(6):786-792.

［11］JIANG Z，LIU S，LI H，et al.Mechanism design and system control for humanoid space robot movement using a simple gravity-compensation system［J］.International Journal of Advanced Robotic Systems，2013，10(389): 502-512.

［12］高吾益.吊絲主動(dòng)重力補(bǔ)償系統(tǒng)設(shè)計(jì)與研究［D］.哈爾濱:哈爾濱工程大學(xué)，2010.GAO W Y.Design and research on active gravity compensation system of hanging silk［D］.Harbin:Harbin Engineering University，2010.

［13］邱亮.基于階躍辨識的PID自整定算法研究及其應(yīng)用［D］.上海:上海交通大學(xué)，2013.QIU L.Research and application on PID auto-tuning control method based on step identification［D］.Shanghai:Shanghai Jiao Tong University，2013.

［14］COHEN G H，COON G A.Theoretical considerations of retarded control［J］.Transactions of the ASME，1953，75:827-834.

2-DOF Control of on-Ground Suspension System for VGT Space Manipulator

FENG Wenwan，YANG Yongsheng，HU Shiqiang
(Shanghai Jiao Tong University，Shanghai 200240，China)

To do on-ground research on a multisection double octahedral variable geometry truss(VGT) space manipulator，suspension system is needed to compensate the gravity of the manipulator.A 2-DOF controller for the system is designed based on the forward kinematics of the manipulator and force analysis.On one DOF，the feed forward signal is calculated by the forward kinematics;on the other DOF，the feedback signal is obtained based on tension difference with PI algorithm.Via combining the two signals to control the length of the cable，the tension is kept constant.The proposed controller not only compensates the structure error that feed forward controller cannot eliminate，but also solves the lag of response of feedback controller.Experiments show that the controller can rapidly regulate the tension with good performances in stability and reliability，which are much better than one-dof controller.

space manipulator;multi-cable suspension system;2-DOF control; gravity compensation

TP242

A

1674-1579(2016)06-0014-06

10.3969/j.issn.1674-1579.2016.06.003

馮文婉(1990—)，女，碩士研究生，研究方向?yàn)槎喙?jié)變幾何桁架機(jī)器臂重力補(bǔ)償與運(yùn)動(dòng)控制;胡士強(qiáng)(1969—)，男，教授，研究方向?yàn)樾畔⑷诤霞夹g(shù)與圖像理解與分析;楊永勝(1971—)，男，副研究員，研究方向?yàn)轱w行器制導(dǎo)與控制非線性濾波與數(shù)據(jù)融合.

*國家自然科學(xué)基金(61175028，61374161)和上海市自然基金(16JC1401100)資助項(xiàng)目.

2016-10-25