基于交集運算的自由度快速求解方法

盧文娟　張立杰　張一同

1.先進鍛壓成形技術(shù)與科學教育部重點實驗室,秦皇島,0660042.燕山大學河北省重型機械流體動力傳輸與控制重點實驗室,秦皇島,066004

基于交集運算的自由度快速求解方法

盧文娟1,2張立杰1,2張一同1,2

1.先進鍛壓成形技術(shù)與科學教育部重點實驗室,秦皇島,0660042.燕山大學河北省重型機械流體動力傳輸與控制重點實驗室,秦皇島,066004

為簡化機構(gòu)自由度計算，基于GOM公式和桿組位移參數(shù)求交，通過分析平行約束力的位置關(guān)系判斷基點轉(zhuǎn)動參數(shù)的有效性，給出并證明了轉(zhuǎn)動不受約束的3種情況，為有效解決集合求交運算中的轉(zhuǎn)動參數(shù)是否被約束問題，以及機構(gòu)自由度快速計算和自由度運動性質(zhì)判別提供了一種簡潔實用的方法。以3種典型機構(gòu)為例，對基點參數(shù)有效性判別和機構(gòu)自由度快速計算進行了驗證。

自由度；快速求解；集合求交；過約束

0　引言

機構(gòu)自由度計算是機構(gòu)分析的最基本問題。在機構(gòu)自由度研究近160年的歷史中，產(chǎn)生了幾十種具有代表性的自由度計算公式，但這些公式中的大多數(shù)在求解某些含有過約束的機構(gòu)時，其直接計算結(jié)果與實際不符[1]，原因在于沒有正確考慮機構(gòu)中的過約束。當機械系統(tǒng)中對同一構(gòu)件提供有兩個或以上作用效果相同的約束時，便產(chǎn)生了過約束。對過約束的處理是機構(gòu)自由度計算的關(guān)鍵，同時也是進行機構(gòu)自由度計算要解決的瓶頸問題。

機構(gòu)過約束處理方法大致分為兩類：一類是在公式中加入過約束的項進行過約束處理的方法，如黃真等提出的修正的K-G公式[1-3]；另一類是從避開過約束角度考慮的機構(gòu)自由度快速求解處理方法，文獻[4-9]為這方面具有代表性的研究成果。

在機構(gòu)學不斷更新的過程中，如何將自由度計算盡量淺顯地表達出來，使其更容易為普通技術(shù)人員所理解具有重要的實際意義。本文以交集計算避開過約束為前提，基于GOM公式[10]介紹一種涉及機構(gòu)轉(zhuǎn)動問題的自由度計算方法。

1　自由度快速求解方法

1.1GOM公式

以揭示機構(gòu)自由度、廣義桿組和輸出參數(shù)三者的內(nèi)在關(guān)系且避開過約束為目的，基于廣義桿組自由度和基點參數(shù)等新概念，建立了一種新的自由度公式——GOM公式。這里定義每個獨立環(huán)路與其相鄰環(huán)路不重復的獨立桿件的組合為廣義桿組，簡稱為桿組。桿組在空間坐標系中位移的向量表達形式為

(1)

由n個桿組位移參數(shù)組成的矩陣稱為位移參數(shù)矩陣，其表達式為

由L個獨立環(huán)路組成的機構(gòu)，其自由度數(shù)目為

(2)

式(1)和式(2)合稱為GOM公式。

1.2自由度快速求解方法的基本思想

以圖1所示機構(gòu)為例，介紹并推導基點角位移參數(shù)有效性的判斷原理。在圖1的兩機構(gòu)中，兩桿組組成分別相同，圖1a中的2個分支Z方向軸線不重合，而圖1b中的2個分支Z方向軸線重合。

(a)F=1，一個轉(zhuǎn)動自由度(b)F=2，2個轉(zhuǎn)動自由度圖1　(Z)U(Y)R(Y)-(Z)U(Y)R(Y)機構(gòu)

圖1中的2個機構(gòu)在圖示坐標軸方向中的位移參數(shù)矩陣均為

表示2個桿組中均存在2個沿Y方向的約束力。不考慮組成并聯(lián)機構(gòu)的2個桿組的軸線關(guān)系對基點參數(shù)的影響，直接求交集得到的基點參數(shù)可記為

2個桿組參數(shù)中均存在沿Z方向的轉(zhuǎn)動角位移，而基點參數(shù)中對應的γ是否有效，取決于Y方向的平行約束力是否約束Z方向的轉(zhuǎn)動。

結(jié)合螺旋理論中約束螺旋和運動螺旋的互易積為零[11]的思想，分析平行約束力(不失一般性地設(shè)為Y方向)對轉(zhuǎn)動(設(shè)為Z方向)的約束關(guān)系。

對于n(n≥2)個同方向的平行約束力構(gòu)成的幾何關(guān)系可能為：共軸、共面平行或空間平行。

(1)平行約束力共軸時，其最大線性無關(guān)數(shù)為1，僅約束沿著約束力方向的移動，不會約束任何轉(zhuǎn)動。

(2)平行約束力共面時，首先寫出由該n個Y方向約束力組成的約束螺旋系。為使得螺旋形式簡單，沿其中一個約束力方向建立坐標系，使其通過坐標系的原點，其約束螺旋系的一般表達形式為

(3)

(3)約束力空間平行時：首先寫出由該n個Y方向約束力組成的約束螺旋系。為使得螺旋形式簡單，沿著其中一個約束力方向建立坐標系，使其通過坐標系的原點，其約束螺旋系的一般表達形式為

(4)

式(4)中第一個和第二個約束螺旋表示2個共面的Y方向約束力，a，c，e可任意選取。由于是空間約束力系，則d和f中至少有一個不為零。對式(4)求其反螺旋，則可得到運動螺旋系的表達式：

(5)

該螺旋系表示具有繞Y方向的轉(zhuǎn)動以及沿X和Z方向的移動，而Z方向的轉(zhuǎn)動是被約束的。

綜上所述可知，某軸線方向的轉(zhuǎn)動不受約束，存在以下三種情況：

情況一：桿組中有平行約束力存在，但平行約束力共線，其垂直方向的軸線轉(zhuǎn)動不被約束。

情況二：桿組中有平行約束力存在，但平行約束力共面，則垂直于平行約束力而與約束力平面共面的軸線轉(zhuǎn)動不被約束。

情況三：桿組中不存在垂直于某轉(zhuǎn)動軸線方向的平行約束力，則該軸線方向的轉(zhuǎn)動不被約束。

1.3自由度快速求解方法的步驟和特點

建立在位移參數(shù)矩陣基礎(chǔ)上的本文自由度快速求解方法，只需簡單判斷轉(zhuǎn)動垂直方向上平行約束力的位置關(guān)系即可進行求解。其求解流程圖如圖2所示。

圖2　基于集合求交自由度求解流程圖

基于以上三種情況進行集合求交計算自由度的方法具有如下特點：

(1)用α、β、γ、x、y、z6個元素描述各桿組的位移特征，可以直接表達各桿組的移動軸線和轉(zhuǎn)動軸線方向。

(2)采用“集合求交”避開了機構(gòu)過約束計算。

(3)將組成機構(gòu)的各桿組作為一個單元，用桿組的位移參數(shù)向量去描述桿組的運動，而非單獨描述某單個運動副的運動。

(4)用機構(gòu)中各桿組的位移特征并行求交處理取代將各個桿組依次疊加進行交集運算的處理方式，以避開環(huán)路數(shù)目較多的機構(gòu)帶來的計算上的不方便。

(5)桿組位移參數(shù)表示桿組對動平臺提供的約束的性質(zhì)和約束力(偶)的方向；利用桿組的廣義自由度進行機構(gòu)的自由度表示，體現(xiàn)了各桿組對輸出構(gòu)件的約束作用。

(6)將螺旋理論思想應用于求交集計算和判斷同方向約束力對垂直方向轉(zhuǎn)動的約束，解決了轉(zhuǎn)動求交不便的問題。

2　求解實例

為將上述提到的機構(gòu)具有某軸線方向轉(zhuǎn)動，且不受約束的三種情況應用到交集運算中，現(xiàn)以三種代表性的典型機構(gòu)為例，進行機構(gòu)自由度快速計算，并驗證機構(gòu)平臺轉(zhuǎn)動與平行約束力的關(guān)系。

例1：沒有平行約束力的求交集問題。

圖3所示為黃真等[12]于2000年發(fā)明的一個完全對稱的4-URU并聯(lián)機構(gòu)，它由4個相同的URU分支同時連接上下平臺構(gòu)成。分支中的第一個是虎克鉸，即U副，第二個是轉(zhuǎn)動副R，第三個也是U副。每個URU分支相當于包含了5個單自由度的轉(zhuǎn)動副，其中間轉(zhuǎn)動副R兩側(cè)的兩個轉(zhuǎn)動副是相互平行的，且第一個轉(zhuǎn)動副與基面相垂直，第5個轉(zhuǎn)動副與運動平臺相垂直，起始時上下平臺平行。

圖3　4-URU機構(gòu)

根據(jù)圖2流程進行的圖3機構(gòu)自由度計算步驟如下：

(1)驗證R12和R22軸線共面不平行時，其軸線是否垂直，且不影響計算結(jié)果。令R12和R22軸線垂直，并分別以R12和R22的軸線方向為坐標軸的X方向和Y方向(圖3)，則機構(gòu)的位移參數(shù)矩陣可表示為

各桿組的位移參數(shù)及桿組的階可分別表示為

(2)不考慮轉(zhuǎn)動是否被約束，通過直接求交集得到基點參數(shù)。其表達式為

(3)基點參數(shù)中僅有Z方向的角位移參數(shù)，且在垂直于Z軸方向上沒有平行約束力，根據(jù)1.2節(jié)中的情況三，即γ為有效參數(shù)，則

(4)根據(jù)GOM公式(式(1)),求得的各桿組的廣義自由度為

將數(shù)值代入GOM公式(式(2))。求得的機構(gòu)自由度數(shù)為

例2：約束力共線時的求交集問題。

圖4所示為對稱的五自由度并聯(lián)機構(gòu)，它由3個相同的RR(RRR)分支同時連接上下平臺。RR(RRR)表示分支由5個轉(zhuǎn)動副構(gòu)成，括號中的3個R表示轉(zhuǎn)動副的軸線交于一個中心點，即3個分支的3個中心點重合于一個共同的中心點。每個分支的前2個轉(zhuǎn)動副平行且垂直于基面[13]。

圖4　3-RR(RRR)并聯(lián)機構(gòu)

(1)為使得到的桿組參數(shù)最少，以匯交中心為坐標軸原點，以Ri1軸線方向為Z軸方向建立坐標系，得到的機構(gòu)位移參數(shù)矩陣為

各桿組的位移參數(shù)及桿組的階分別為

(3)基點參數(shù)中存在3個角位移參數(shù)，且在Z方向上存在3個相平行的約束力，且3個約束力的作用點均作用在匯交中心，即3個約束力共線，滿足1.2節(jié)中介紹的情況一，即存在一個公共約束，但不對任何轉(zhuǎn)動產(chǎn)生約束，基點參數(shù)中不存在無效參數(shù)。其數(shù)學表達式為

(4)根據(jù)GOM公式計算的各桿組的廣義自由度為

計算的機構(gòu)自由度為

例3：轉(zhuǎn)動受平行約束力約束的求交集問題。

圖5所示為一3分支S/PRS/PSS非對稱并聯(lián)機構(gòu)[14]，機構(gòu)的上下平臺都是三角形。機構(gòu)桿組1中僅有一個球副，桿組2是5自由度PRS運動鏈，桿組3是7自由度PSS運動鏈，為無約束分支，不對動平臺產(chǎn)生約束。

圖5　S/PRS/PSS非對稱并聯(lián)機構(gòu)

(1)為使得到的桿組參數(shù)最少，以轉(zhuǎn)動副R的軸線方向為Y軸。得到的機構(gòu)位移參數(shù)矩陣表達式為

各桿組的位移參數(shù)及桿組的階分別為

(3)基點參數(shù)中存在3個角位移參數(shù)，且在Y方向上存在2個相平行的約束力。2個約束力的作用點分別在桿組1和桿組2的球副中心(圖5)，不滿足1.2節(jié)中介紹的三種情況，不能構(gòu)成過約束，但會約束動平臺的一個轉(zhuǎn)動，即約束兩力所決定的平面法線方向的轉(zhuǎn)動，使得基點參數(shù)中角位移參數(shù)γ成為無效參數(shù)，即

(4)根據(jù)GOM公式計算的各桿組的廣義自由度為

計算的機構(gòu)自由度為

3　結(jié)論

為簡化機構(gòu)自由度計算，本文基于GOM公式和桿組位移參數(shù)求交法，以及螺旋理論分析了平行約束力的三種位置關(guān)系，結(jié)合基點轉(zhuǎn)動參數(shù)的有效性，給出了轉(zhuǎn)動不受約束的三種情況：

(1)桿組中有平行約束力存在，但平行約束力共線，其垂直方向的軸線轉(zhuǎn)動不被約束。

(2)桿組中有平行約束力存在，但平行約束力共面，則垂直于平行約束力而與約束力平面共面的軸線轉(zhuǎn)動不被約束。

(3)桿組中不存在垂直于某轉(zhuǎn)動軸線方向的平行約束力，則該軸線方向的轉(zhuǎn)動不被約束。

基于本文三種情況的機構(gòu)自由度計算方法，可有效解決集合求交運算中的轉(zhuǎn)動參數(shù)有否被約束的問題，為機構(gòu)自由度快速計算和自由度運動性質(zhì)判別提供了一種簡潔、實用的方法。同時也為機構(gòu)自由度的深入研究和復雜機構(gòu)自由度的化簡分析開辟了新的途徑。

[1]GoguG.MobilityofMechanisms:aCriticalReview[J].Mech.Mach.Theory,2005, 40(9): 1068-1097.

[2]黃真. 論機構(gòu)自由度——尋找了150年的自由度通用公式[M].北京:科學出版社,2011.

[3]LiuJingfang,HuangZhen.MobilityAnalysisofSomeParadoxicalMechanismsUsingaGeneralMethodology[C]//Proceedingsof2008ASMEInternationalDesignEngineeringTechnicalConferences.NewYork:ASME,2008:1421-1426.

[4]GoguG.MobilityandSpatialityofParallelRobotsRevisitedviaTheoryofLinearTransformations[J].EuropeanJournalofMechanics-A/Solids, 2005, 24(4): 690-711.

[5]GoguG.BifurcationinConstraintSingularitiesandStructuralParametersofParallelMechanisms[J].Meccanica，2011，46(1)：65-74.

[6]RicoJM,GallardoJ,RavaniB.LieAlgebraandtheMobilityofKinematicChains[J].JournalRoboticSystems, 2003, 20(8): 477-479.

[7]楊廷力,劉安心. 機器人機構(gòu)拓撲結(jié)構(gòu)設(shè)計[M]. 北京:科學出版社, 2012.

[8]ZhangYitong,MuDejun.NewConceptandNewTheoryofMobilityCalculationforMulti-loopMechanisms[J].Sci.ChinaTech.Sci., 2010, 53(6): 1598-1604.

[9]ZhangYitong,LiYanwen,WangLiya.ANewFormulaofMechanismMobilityBasedonVirtualConstraintLoop[J].Sci.ChinaTech.Sci., 2011, 54(10): 2768-2775.

[10]ZhangYitong,LuWenjuan,MuDejun,etal.ANovelMobilityFormulaforParallelMechanismsExpressedwithMobilityofGeneralLink-group[J].ChineseJournalofMechanicalEngineering, 2013,26(6):1082-1090.

[11]黃真，趙永生，趙鐵石. 高等空間機構(gòu)學[M].北京:高等教育出版社, 2006.

[12]HuangZhen,LiQinchuan.GeneralMethodologyforTypeSynthesisofLower-mobilitySymmetricalParallelManipulatorsandSeveralNovelManipulators[J].InternationalJournalofRoboticsResearch, 2002, 21(2): 131-145.

[13]黃真, 李秦川. 五自由度全對稱運動解耦并聯(lián)機器人機構(gòu):中國,ZL01122274.3[P]. 2002-02-13.

[14]ZengDaxing,HuangZhen,LuWenjuan.AFamilyofNovel2DOFRotationalDecoupledParallelMechanisms[C]//Proceedingsof2007InternationalConferenceonMechatronicsandAutomation.Harbin,China, 2007:2478-2483.

(編輯何成根)

Fast Solution Method of Mobility Calculation Based on List Intersection

Lu Wenjuan1,2Zhang Lijie1,2Zhang Yitong1,2

1.Key Laboratory of Advanced Forging & Stamping Technology and Science,Ministry of Education of China, Yanshan University,Qinhuangdao,Hebei,066004 2.Hebei Key Laboratory of Heavy Mechinery Fluid Power Transimission and Control,Yanshan University,Qinhuangdao,Hebei,066004

In order to express DOF calculation as simple as possible, based on the GOM formula and the intersection calculation of displacement parameters of general link group, three cases were presented and proved when the rotation was not as constrained. These cases were proposed by analyzing the relationship of parallel constrain forces to judge the validity of base point parameters. Therefore, the problem of the validity judgement of base point parameters in the calculation of “rotation intersection” was solved effectively. And it provides a neat and practical method for the quick determination of the DOF and motion characteristics. Finally several typical examples from the literature were performed to show how to judge the validity of base point parameters and to calculate the DOF with the method mentioned above.

degree of freedom(DOF); fast solution; list intersection; virtual constraint

2013-11-08

國家自然科學基金資助項目(51005195, 51275438)；河北省高等學?？茖W技術(shù)研究項目(QN2014175)

TH112DOI：10.3969/j.issn.1004-132X.2015.04.018

盧文娟，女，1983年生。先進鍛壓成形技術(shù)與科學教育部重點實驗室、燕山大學機械工程學院博士研究生。主要研究方向為并聯(lián)機構(gòu)自由度分析和型綜合。發(fā)表論文10余篇。張立杰(通信作者)，男，1969年生。燕山大學機械工程學院教授、博士研究生導師。張一同，男，1945年生。燕山大學機械工程學院教授。