李 巍，趙志剛，石廣田，孟佳東

（蘭州交通大學機電工程學院，甘肅蘭州730070）

多機器人并聯繩牽引系統的運動學及動力學解

李 巍，趙志剛，石廣田，孟佳東

（蘭州交通大學機電工程學院，甘肅蘭州730070）

對于多臺機器人通過繩索協同牽引負載的并聯系統，考慮了每個機器人與繩索的連接點具有任意移動的3個平動自由度的一般性情況.對該系統建立廣義性的運動學方程，分別利用牛頓-歐拉方程和拉格朗日方程建立系統的動力學方程.根據機器人、繩索、負載三者之間的關系，分成三大類問題，從方程是否有解的角度，分別對各類問題下解的情況進行分析.從實際應用的角度，討論各種情況下解的處理方法.對于無解或無窮解時，提出解決方法.對于有解時，提出舍去不符合設計要求的解的方法.若存在多組解，則提出一個尋找最優(yōu)解的方法.通過舉例仿真驗證系統的運動學和動力學模型并說明解的處理方法.

多機器人系統；繩牽引系統；運動學；動力學

隨著機器人技術的發(fā)展，為了滿足一些應用場合的任務需求，需要多機器人間協同作業(yè).在實際應用中可能遇到多機器人對一大重物的拖曳、吊運、調整重物姿態(tài)等操作，該類多機器人系統的特點是通過繩索將負載與機器人相連，其工作特點類似并聯機器人，因此可以看成繩牽引并聯機器人.該類系統具有低轉動慣量、承載能力強、工作空間大、響應速度快、可重構和模塊化設計等特點.

20世紀80年代，Landsberger[1]首先設計了一種用于海下作業(yè)的3自由度繩牽引并聯機構，并對此機構進行了力學分析及控制.Ming等[2]首次提出將繩牽引并聯機器人分為兩大類：1）當m≤n時，為不完全約束定位機構（IRPM）.其中，m為繩的根數，n為定位物體的自由度數；2）當m≥1+n時，為完全約束定位機構（CRPM）.Ming等[2]考慮的機構是繩的一端連在負載上，另一端是通過固定不動的滑輪連接馬達，而不是連在能夠移動的機器人上，因此需要做成特定的機構，并且只能通過變化繩長來實現負載的運動，同時負載的工作空間不具有擴展性.Yamamoto等[3-4]研究的不完全約束機構與Yu 等[5]研究的3種6自由度繩牽引門式起重機機器人機構類似，都是繩的一端連在有軌電車上，電車能夠在導軌上沿著一個方向移動，這樣繩與電車的連接點具有一個自由度，但有一定的局限性.Kumar 等[6-9]建立了m臺四旋翼無人機通過繩索協同吊運負載的靜平衡方程，其中每個無人機具有3個自由度，但對此系統逆運動學和動力學分析時，主要考慮的是3臺無人機的情況；因此，并未分析該類系統有解的必要條件.

針對上述文獻中的一些不足，有必要考慮一般性情況.本文研究的m（m≥1）臺機器人通過繩索協同牽引負載的并聯系統，是在文獻[2]的基礎上，考慮每個機器人與繩索的連接點具有3個平動自由度的一般性情況.每個機器人與一根繩索相連，負載具有n（1≤n≤6）個自由度，繩長可以變化，也可以不變.于是，每個機器人具有任意移動性，系統變得更加靈活，負載的工作空間可大可小.系統中的機器人間可以隨意重組，這樣機器人不局限于特定的機構，可以是有特定導軌的吊運車、底座固定的串聯機器人、地面上移動的機器人，也可以是空中飛行的無人機等.本文對該系統建立廣義的運動學和動力學方程，分析機器人個數與負載自由度個數滿足什么關系時達到有解的必要條件，提出對于無解和無窮解情況時的一些解決方法和一個尋找最優(yōu)解的方法.

1 運動學方程的建立

m臺機器人通過繩索協同牽引負載如圖1所示，由m根繩和1個n自由度負載組成.本文重點研究的是繩索與機器人連接點的運動情況，未考慮機器人本身，因此可以把機器人看成質點進行分析.由于機器人看成質點，繩索與機器人的連接點Pm即機器人的位置，通過機器人位置的變化和繩長的變化來實現對負載的牽引.負載指的是多繩牽引的不發(fā)生變形的剛性物體.繩索與負載的連接點分別用Bm表示.在地面上建立全局坐標系O-XYZ，在負載的質心上建立局部坐標O＇-X＇Y＇Z＇.

圖1 繩牽引系統示意圖Fig.1 Schematic diagram of cable-driven system

負載質心O＇在全局坐標系的位置為

局部坐標系相對于全局坐標系X軸、Y軸、Z軸的歐拉角分別為γ、β、α，則局部坐標系相對于全局坐標系的旋轉矩陣為

式中：c表示cos，s表示sin.

繩索與機器人的連接點Pm在全局坐標系的位置表示為Pm=[xPm，yPm，zPm]T，繩索與負載的連接點Bm在全局坐標系的位置表示為Bm=[xBm，yBm，zBm]T.設bm是Bm在局部坐標系中的坐標，則可得

由Pm、Bm可得繩長公式：

將式（1）～（3）代入式（4）可以得到負載的位置、歐拉角與Pm之間的關系，即系統的運動學方程.同時可以得到推論1：m根繩（即m臺機器人）能夠建立m個運動學方程.

2 動力學方程的建立

分別利用牛頓-歐拉方程和拉格朗日方程建立系統的動力學方程，來驗證推論2.

2.1 基于牛頓-歐拉方程的動力學

每根繩用零節(jié)距的單位旋量在全局坐標系下表示為

設負載的質量為M，則重力用零節(jié)距的單位旋量在全局坐標系表示為

負載在全局坐標系的速度和角速度分別為v、ω，則

負載在局部坐標系中的慣性矩陣為I，則在全局坐標系中的慣性矩陣為

設每根繩的張力分別為T1，T2，…，Tm，對負載利用牛頓-歐拉方程[10]可得

式中：I3為3×3單位矩陣.

聯立式（5）～（10）可得系統的動力學方程.

2.2 基于拉格朗日方程的動力學

負載質心的動能為

負載的轉動動能為

負載的總動能為

負載的重力勢能為

建立廣義坐標qi分別為x、y、z、α、β、γ的拉格朗日方程：

作用在負載上的廣義力為

繩長向量為

系統的雅可比矩陣為

繩的拉力向量為

利用虛功原理[11]可得

聯立式（11）～（21）可以得到系統的動力學方程.

通過2.1節(jié)和2.2節(jié)所建立的動力學方程都可以轉換成AT=C的形式，其中A為n×m的矩陣，A與繩向量有關.T為m×1的繩拉力矩陣.由此可以得到推論2：無論是牛頓-歐拉方程還是拉格朗日方程，負載有n個自由度能夠建立n個動力學方程.

3 關于三類問題的解的討論

由于每個機器人與繩索的連接點具有3個平動自由度，有m（m≥1）臺機器人，故機器人共有3m個變量.有m根繩，故繩長變量有m個，拉力變量有m個.負載有n個自由度，故有n（1≤n≤6）個變量.

以下討論中的前提條件是除了一些變量給定固定值外，其他變量默認都與時間t之間存在關系.需要特別說明的是，研究的系統處于非奇異狀態(tài)，同時利用了文獻[2]的一些結論.本節(jié)僅是從數學的角度，討論了各類問題下解的情況，一般須考慮動力學，判斷繩的拉力是否滿足要求.4章將詳細討論求解的方法.

根據機器人、繩索、負載三者的關系，可以分成三大類問題，詳述如下.

3.1 正問題

3.1.1 繩長未知

1）正運動學：已知機器人的運動狀態(tài)求負載的運動狀態(tài)和繩長.機器人的運動狀態(tài)指的是機器人的3m個變量.負載的運動狀態(tài)指的是負載的n個變量.以下同理.

根據第2章的推論可知，m臺機器人能夠建立m個運動學方程，故方程數為m個.未知變量為負載的自由度和繩長變量，共有m+n個.由于m＜m+n，方程個數小于未知量個數，該類情況存在無窮解.以下同理.

2）加入正動力學：已知機器人的運動狀態(tài)求負載的運動狀態(tài)、繩長和繩的拉力.

根據第2章的結論可知，無論是牛頓-歐拉方程還是拉格朗日方程，負載有n個自由度能夠建立n個動力學方程，加入動力學方程后，總方程數為m+ n個.未知變量為負載的自由度、繩長變量和拉力變量，故共有m+m+n個.由于m+n＜m+m+n，方程個數小于未知量個數，該類情況存在無窮解.以下討論方法同理.可得推論3：當繩長未知時，無論正運動學還是加入正動力學，都存在無窮解.

3.1.2 繩長已知 繩長已知指的是繩的長度不變且已知，也可以是繩長隨時間t變化的函數已知.

1）正運動學：已知機器人的運動狀態(tài)和繩長求負載的運動狀態(tài).

運動學方程數為m個，未知變量為負載的自由度，共n個.可以得到推論4：當繩長已知時，正運動學中，當m=n時，方程個數等于未知量個數，該類情況有解.當m＞n時，方程個數大于未知量個數，為了獲得解，考慮（m-n）根的繩長未知，可以得到解.當m＜n時，方程個數小于未知量個數，存在無窮解.

2）加入正動力學：已知機器人的運動狀態(tài)和繩長求負載的運動狀態(tài)和繩的拉力.

運動學方程和動力學方程總數為m+n個，未知變量為負載的自由度和拉力，共m+n個.由于m+n=m+n，可以得到推論5：當繩長已知時，聯立正運動學和正動力學，無論m、n滿足什么關系，該類情況都有解.

3.2 逆問題

3.2.1 繩長未知

1）逆運動學：已知負載的運動狀態(tài)求機器人的運動狀態(tài)和繩長.

運動學方程數為m個，未知變量為機器人的變量和繩長變量，共m+3m個.由于m＜4m，方程個數小于未知量個數，該類情況存在無窮解.

2）加入逆動力學：已知負載的運動狀態(tài)求機器人的運動狀態(tài)、繩長和繩的拉力.

運動學方程和動力學方程總數為m+n個，未知變量為機器人的變量、繩長變量和拉力變量，共3m+m+m個.為了獲得解，m+n=3m+m+m，即n=4m.由于m≥1、1≤n≤6且m、n都為正整數，只有當m=1，n=4時，有解.當m=1，n=5、6時，可能有解.除上述情況外，方程個數都小于未知量個數，因此存在無窮解.

3.2.2 繩長已知

1）逆運動學：已知負載的運動狀態(tài)和繩長求機器人的運動狀態(tài).

運動學方程數為m個，未知變量為機器人的變量，共3m個.由于m＜3m，方程個數小于未知量個數，該類情況存在無窮解.

2）加入逆動力學：已知負載的運動狀態(tài)和繩長求機器人的運動狀態(tài)和繩的拉力.

運動學方程和動力學方程總數為m+n個，未知變量為機器人的變量和拉力變量，共3m+m個.為了獲得解，m+n=3m+m，即n=3m.由于m≥1，1≤n≤6且m、n都為正整數，只有當m=1，n=3和m=2，n=6時有解.當m=1，n=4、5、6時，可能有解.除上述情況外，方程個數都小于未知量個數，因此存在無窮解.

通過上面的分析可以得到推論6：在逆問題中，除了少數幾種情況有解或可能有解，大部分情況下，方程個數小于未知量個數，存在無窮解.在實際應用中，逆問題的求解比較重要，因此在4章中將詳細敘述解決方法.

3.3 特殊情況

1）運動學：已知機器人和負載的運動狀態(tài)求繩長.

運動學方程數為m個，未知變量為繩長變量，共m個.由于m=m，且從式（1）～（4）可以看出，繩長公式里根號下全已知，因此可以得到推論7：特殊情況的運動學中有解且唯一，如果已知的是機器人和負載的變量的解析式，那么可以得到繩長唯一的解析式.

2）加入動力學：已知機器人和負載的運動狀態(tài)求繩長和繩的拉力.

運動學方程和動力學方程總數為m+n個，未知變量為繩長變量和拉力變量，共m+m個.可以得到推論8：特殊情況中聯立運動學和動力學后，當m+n=m+m，即n=m時，該類情況有解.當n＞m 時，可能有解.當n＜m時，有無窮解.

4 求解方法

第3章僅從數學中方程是否有解的角度，討論了各類問題下解的情況，分為無窮解、有解、可能有解3種情況.本節(jié)從實際應用角度，討論求解的方法，其中解方程組、4.3節(jié)解的判斷和4.4節(jié)尋找最優(yōu)解的方法都可以通過編程實現，求解方法詳細描述如下.

1）先確定已知條件和未知條件，根據第3章的分類，確定屬于哪一類問題.

2）利用第3章中的推論3～8，根據機器人個數m與負載自由度個數n滿足什么關系，判斷是否達到有解的條件.

3）若屬于無窮解的情況，則按4.1節(jié)進行處理.若屬于可能有解的情況，則按4.2節(jié)進行處理.通過上述處理后，使之達到滿足有解的條件.

4）在達到有解的條件后，將已知條件代入式（1）～（4）聯立得到的運動學方程和式（5）～（10）或式（11）～（21）聯立得到的動力學方程進行求解.

5）除了3.3節(jié)運動學中能夠獲得唯一解析式外，3章中其他問題一般得不到解析式，且大部分是多組數值解，因此從實際應用的角度需要對解進行判斷，判斷方法見4.3節(jié).

6）對解判斷后，會有以下3種結果.

a）在比較多的時刻沒有滿足要求的解，此時需要調整已知條件，重新求解.

b）對解判斷后，一些時刻仍存在多組解.在正問題中，若得到多組解，則可以得到負載在空間可能的位置.在逆問題中，若得到多組解，則需要尋找最優(yōu)解，具體方法見4.4節(jié).

c）在少量個別時刻無解，考慮插入平均值.若其他某些時刻有多組解，則按b）中的結果處理.

4.1 無窮解的情況

對于無窮解的情況，可以考慮添加約束k個，減少未知量的個數，使方程個數等于未知量個數，從而獲得解.其中對一個變量的限制即一個約束.變量的限制可以是變量具體值已知、隨時間t變化的函數已知、也可以是各變量之間滿足什么關系.如m根繩的張力始終相等，大小未知，相當于添加了m-1個約束.

例如，在3.2節(jié)的逆問題中，大部分情況下存在無窮解.在實際應用中，逆問題比較重要，因此考慮添加約束，從而獲得解.在3.2.1節(jié)中繩長未知時，加入動力學后，方程總數為m+n，未知量總數為3m+m+m.添加k個約束，使m+n=3m+ m+m-k，從而獲得解.此時，約束k可以是對機器人的自由度限制、繩長限制和繩的張力限制.在3.2.2節(jié)繩長已知時，加入動力學后，方程總數為m+ n，未知量總數為3m+m.添加k個約束，使m+n= 3m+m-k，從而獲得解.此時，約束k可以是對機器人的自由度限制和繩的張力限制，此時的情況可以看作是在3.2.1節(jié)繩長未知時的基礎上多添加了m個約束.

4.2 可能有解的情況

可能有解的原因是方程個數大于未知量個數，造成方程約束過多，有2種結果——有解或無解.此

式中：s表示經過上面解的判斷后滿足要求的解，s的上標表示時刻，下標表示此時刻滿足要求的第幾個解；N為總共相減的次數，即圓括號的個數.

若s為機器人坐標值，則Δ表示機器人整體平均速度的倍數，用來考慮機器人軌跡是否平滑.若s為繩的拉力，則Δ表示繩的拉力整體平均變化值的倍數，用來考慮繩的拉力變化是否平滑.若s為繩長，則Δ表示繩長整體平均速度的倍數，用來考慮繩長變化是否平滑.

2）每個變量的多組數值解經過4.3節(jié)的處理后，必定在一些時刻數值解的個數小于其他時刻.從解的個數最少時刻出發(fā)，分別向上和向下，選擇兩時刻解的差值離Δ最接近的值.于是，每個變量能夠選出少量幾條解，由于各個變量之間的解存在對應的關系，各個變量對應的解也能被選出來.

3）由于每個變量都有一個Δ，多個變量可以選出多條解.此時，可以考慮從下面幾點中選出最優(yōu)解，下面幾點也可以并用.

a）從實際控制的角度來考慮，比較機器人軌跡平滑度、繩長變化平滑度、繩拉力變化平滑度等哪個更重要，這樣便于控制，從而選出最優(yōu)解.

b）直觀比較哪個圖更平滑，從而選出最優(yōu)解.

c）比較每個變量的|Δ|的值，選擇|Δ|最小的作為最優(yōu)解，|Δ|越小，說明變量的值整體變化程度越小，或者在步驟2）中選出的幾條解的基礎上求Δ，再比較每個變量的|Δ|的值，從而選出最優(yōu)解.時，需要具體情況具體分析.若無解，則可以考慮減少已知變量的個數，使方程個數等于未知量個數，從而獲得解.

4.3 解的判斷

1）從解中舍去虛數解、繩的拉力小于等于零和超過繩的張力極限的情況.各個變量之間的解存在對應的關系，因此對應的解要舍去.

2）從解中舍去同一時刻各個機器人間有相同的坐標點的解，否則機器人會碰在一起，還要舍去繩索交錯在一起的解.各個變量之間對應的解要舍去.

3）從解中舍去不符合設計前提條件的解，各個變量之間對應的解要舍去.例如，算出來的機器人位置超出了設計范圍.

4.4 尋找最優(yōu)解的方法

1）先求出目標函數：

5 實例仿真

在實際應用中，3.2節(jié)的逆問題和3.3節(jié)的特殊情況問題應用較多，本節(jié)將分別舉例仿真說明.5.1 逆問題仿真

根據3.2節(jié)的推論可知，無論是逆運動學還是加入逆動力學，3根繩牽引6自由度負載，存在無窮解.按照4.1節(jié)的思想可知，運動學和動力學方程總共9個，假設繩長變化且未知，這樣繩長變量和拉力變量共6個，還有3個變量.考慮每個機器人都有一個變量，如3個機器人都走直線，行走的位移為變量.機器人可以是門式起重機中的電車[5]，也可以是底座固定的串聯機器人或是其他移動機器人等.可以考慮3個機器人的初始位置E1（2.5，51.5）、E2（-2.5，5，1.5）成正三角形，邊長D=5 m.3個機器人分別行走的位移為S1、S2、S3，位移與全局坐標系XOY面平行，示意圖如圖2所示.

設負載是一個正三角形，頂點分別為B1、B2、B3，也是繩索與負載的連接點.質量M=1kg，負載質心O＇到頂點的距離d=0.1 m.設負載質心O＇在全局坐標系中期望的軌跡方程和負載的姿態(tài)角方程如下：

可得如圖3所示期望的軌跡.該軌跡有6個自由度.

圖2 3臺機器人位移示意圖Fig.2 Displacement schematic diagram of three robots

圖3 逆問題仿真：負載期望的軌跡Fig.3 Desired trajectory of payload for inverse case simulation

圖4 逆問題仿真結果Fig.4 Simulation results of inverse case

聯立第1、2章建立的運動學和動力學方程組，解出每個變量每個時刻有8個值.按照4.3節(jié)的方法對解進行處理后，發(fā)現剩余的解在同一時刻是相同的，因此，得出每個變量每個時刻只有一個解.繩長隨時間變化的曲線如圖4（a）所示，拉力變化的曲線如圖4（b）所示.每個機器人的位移變化曲線如圖4（c）所示.

從圖3和式（23）可以看出，負載在向E3點方向靠近；從圖4（c）可以看出，機器人2在向E3點方向靠近，因此在圖4（a）上反映出繩2和繩3的長度整體呈減少的趨勢，繩1的長度呈增加的趨勢.由于負載在向E3點方向靠近，圖4（c）中機器人3的位移減少.負載在X、Y軸負方向作加速運動，同時向Z軸負方向勻速運動，因此繩與Z軸正方向的夾角減少.為了平衡X、Y軸方向的加速度，所需的拉力會變大，所以在圖4（b）中反映出3根繩的拉力都呈變大的趨勢.

5.2 特殊情況仿真

對于軌跡已知的地面上移動的機器人或空中飛行的無人機等牽引有期望軌跡的負載時，只能通過變化繩長來實現，因此可以利用3.3節(jié)的推論.如3臺移動機器人要牽引6自由度負載，根據3.3節(jié)的推論7可知，運動學中能夠得到唯一解，但為了確認負載期望軌跡能夠實現，加入動力學，再根據推論8可知，自由度數多于繩數，可能會無解，如下文的實例仿真無法直接得到解.為了保證有解，考慮將負載的6個自由度分2步進行，先平動3個自由度再姿態(tài)變化3個自由度.

設3臺移動機器人保持正三角形隊形平行于全局坐標系XOY平面，且向Y軸正方向移動，三角形邊長D=5 m，3個機器人P1、P2、P3的坐標方程為

設負載是正三角形，參數與5.1節(jié)相同.負載質心O＇在全局坐標系中期望的軌跡方程和負載的姿態(tài)角方程如下：

式（24）將負載的6個自由度分解成平動和轉動2步進行，則得到如圖5所示期望的軌跡.

圖5 特殊情況仿真：負載期望的軌跡Fig.5 Desired trajectory of payload for special case

聯立第1、2章建立的運動學和動力學方程組，解出每個變量每個時刻只有1個值.繩長隨時間變化的曲線如圖6（a）所示，拉力變化的曲線如圖6（b）所示.

圖6 特殊情況仿真結果Fig.6 Simulation results of special case

從圖5和式（24）可以看出，負載在0～5 s內的軌跡是隨著機器人一起移動的螺旋線，因此在圖6中繩長和拉力變化都類似于正弦或余弦曲線.圖6（a）中，3條曲線在0～5 s時都呈下降的趨勢，是因為負載有Z軸正方向的速度，離機器人越來越近，所以繩長有變小的趨勢.圖6（b）中，3條曲線在0～5 s時都呈上升的趨勢，是因為繩與Z軸正方向的夾角增大，繩的拉力Z軸正方向的分力有減少的趨勢；為了克服重力，所以繩的拉力有變大的趨勢.在第5 s時刻，負載的軌跡發(fā)生變化，因此圖6（b）中的拉力會發(fā)生突變，但2個軌跡是對接的，所以圖6（a）中的繩長不會發(fā)生突變.在5～10 s內，負載隨著機器人一起移動僅作姿態(tài)的變化，且變化角度不大，因此在圖6中，繩長和拉力變化都平緩.

6 結 論

（1）對該系統建立了廣義的運動學和動力學方程，通過分析得到推論1：m個機器人能夠建立m個運動學方程.推論2：負載有n個自由度就能建立n個動力學方程.

（2）根據機器人、繩索、負載三者的關系，進行三大類的劃分；然后分別討論各種情況下機器人個數與負載自由度個數滿足什么關系時解的情況，即推論3～8.

（3）對于無窮解和可能有解時，提出一些求解方法，考慮添加或減少約束，使方程個數等于未知量個數，從而獲得解.對于存在多組解時，提出了舍去不符合設計實際要求的解的判斷方法和一個尋找最優(yōu)解的方法.

本文未詳細討論防止繩索交錯的方法，僅是從解上判斷.在設計時，須提前考慮每個機器人的空間范圍，負載的姿態(tài)角不宜偏轉過大，來防止繩索交錯.本文的研究結果將為多機器人繩牽引系統的設計方案提供參考，同時用于進一步研究系統的剛度、穩(wěn)定性分析和系統的控制等.

（

）：

[1]LANDSBERGER S E.Design and construction of a cable-controlled，parallel link manipulator[D].Boston：Massachusetts Institute of Technology，1984.

[2]MING A，HIGUCHI T.Study on multiple degree of freedom positioning mechanisms using wires（Part1）：concept，design and control[J].International Journal of the Japan Society for Precision Engineering，1994，28（2）：131-138.

[3]YANAI N，YAMAMOTO M，MOHRI A.Inverse dynamics analysis and trajectory generation of incompletely restrained wire-suspended mechanisms[C]∥Proceedings2001 ICRA.IEEE International Conference on Robotics and Automation.Seoul：IEEE，2001：3489-3494.

[4]YAMAMOTO M，YANAI N，MOHRI A.Trajectory control of incompletely restrained parallel-wire-suspended mechanism based on inverse dynamics[J].IEEE Transactions on Robotics，2004，20（5）：840-850.

[5]YU Lan，ZHENG Ya-qing.Configuration design and analysis of generalized inverse posekinematic problem of 6-DOF wire-driven gantry crane robots[C]∥International Conference on Automatic Control and Artificial Intelligence（ACAI2012）.Xiamen：IET，2012：676-680.

[6]JIANG Qi-mi，KUMAR V.The inversekinematics of 3-d towing[M]∥Advances in Robot Kinematics：Motion in Man and Machine.Berlin：Springer，2010：321-328.

[7]MICHAEL N，FINK J，KUMAR V.Cooperative manipulation and transportation with aerial robots[J].Autonomous Robots，2011，30（1）：73-86.

[8]FINK J，MICHAEL N，KIM S，et al.Planning and control for cooperative manipulation and transportation with aerial robots[J].The International Journal of Robotics Research，2011，30（3）：324-334.

[9]JIANG Qi-mi，KUMAR V.The inversekinematics of cooperative transport with multiple aerial robots[J].IEEE Transactions on Robotics，2013，29（1）：136-145.

[10]ZI Bin，SEN Qian，DING Hua-feng，et al.Design and analysis of cooperative cable parallel manipulators for multiple mobile cranes[J].International Journal of Advanced Robotic Systems，2012，9（207）：1-10.

[11]警斌，段寶巖，杜敬利.柔索驅動并聯機器人動力學建模與數值仿真[J].機械工程學報，2007，43（11）：82-88.

ZI Bin，DUAN Bao-yan，DU Jing-li.Dynamic modeling and numerical simulation of cable-driven parallel manipulator[J].Journal of Mechanical Engineering，2007，43（11）：82-88.

Solutions ofkinematics and dynamics for parallel cable-driven system with multi-robots

LI Wei，ZHAO Zhi-gang，SHI Guang-tian，MENG Jia-dong

（School of Mechatronic Engineering，Lanzhou Jiaotong University，Lanzhou 730070，China）

The general situation of connection point that has three translational degrees of freedom with free movement between each robot and the cable was considered for the parallel system of multi-robots cooperatively towing a payload by cables.The generalizedkinematic equations of the system were established，and the dynamic equations of the system were established by respectively using the Newton-Euler equation and Lagrange equation.The system was divided into three types of issues according to relation among robots，cables and payload.The situations of solution to allkinds of issues were respectively analyzed from the view whether equations have solutions.Then the processing method was discussed in each case from the view of practical application.When there were no solution or infinite solutions，some solving methods were proposed.When there were solutions，the method of removing the solutions that don’t meet the design requirements was proposed.If there were multiple groups of solutions，a method of searching for optimal solution was proposed.Thekinematic and dynamic model were verified by simulation examples，and the processing method of the solutions was illustrated.

multi-robots system；cable-driven system；kinematics；dynamics

TP242

A

1008-973X（2015）10-1916-08

2015-03-05.浙江大學學報（工學版）網址：www.journals.zju.edu.cn/eng

國家自然科學基金資助項目（51265021）；教育部高等學校博士學科點專項科研基金資助項目（20126204120004）；甘肅省自然科學基金資助項目（1212RJZA067）；教育部科學技術研究重點資助項目（212184）.

李巍（1988—），男，碩士生，從事多機器人技術和復雜系統建模的研究.E-mail：skhkzxx@163.com

趙志剛，男，教授.ORCID：0000-0002-5998-891X.E-mail：zhaozhg@mail.lzjtu.cn