專利名稱：仿人機(jī)器人機(jī)械臂避碰運(yùn)動(dòng)軌跡規(guī)劃方法
技術(shù)領(lǐng)域：
本發(fā)明屬于機(jī)器人領(lǐng)域，尤其是一種仿人機(jī)器人機(jī)械臂避碰運(yùn)動(dòng)軌跡規(guī)劃方法。
背景技術(shù)：
機(jī)械臂的軌跡規(guī)劃是指，在滿足一定約束的條件下，規(guī)劃一條從起始位姿到目標(biāo)位姿的無碰撞的運(yùn)動(dòng)路徑。根據(jù)規(guī)劃空間的不同，軌跡規(guī)劃方法可分為基于關(guān)節(jié)空間的軌跡規(guī)劃和基于任務(wù)空間(即笛卡爾空間)的軌跡規(guī)劃兩種。這兩種方法均有一定的局限性，由于機(jī)械臂作業(yè)通常在笛卡爾空間描述，所以基于關(guān)節(jié)空間的軌跡規(guī)劃方法對(duì)任務(wù)的描述不直觀，而基于任務(wù)空間的軌跡規(guī)劃則需要實(shí)現(xiàn)將笛卡爾空間的位姿進(jìn)行逆運(yùn)動(dòng)學(xué)求解，轉(zhuǎn)換為機(jī)械臂各個(gè)關(guān)節(jié)角，需要大量的運(yùn)算，而且無法保證整條笛卡爾空間的軌跡中不存在奇異構(gòu)型，所以基于笛卡爾空間的軌跡規(guī)劃方法很難應(yīng)用于實(shí)時(shí)控制。目前，軌跡規(guī)劃方法主要有矩形加速度函數(shù)法，梯形加速度函數(shù)法，B樣條曲線法，多項(xiàng)式插值法等。其中矩形加速度函數(shù)法計(jì)算簡単，易于實(shí)現(xiàn)，可應(yīng)用于實(shí)時(shí)應(yīng)用場合。目前，對(duì)機(jī)械臂無碰撞軌跡規(guī)劃的研究已有很多，Lazona-Perze在Automaticplanning of manipulator transfer movement 和 bpacial planning: a configurationspace approach兩篇文章中，提出了一種基于C空間規(guī)劃方法的自由空間法，該方法能夠規(guī)劃出無碰撞的機(jī)械臂運(yùn)動(dòng)軌跡，但該方法中對(duì)障礙物的建模方法比較復(fù)雜，所以規(guī)劃的效率比較低，不適于實(shí)時(shí)應(yīng)用。Khabit在Real-time obstacle avoidance formanipulators and mobile robots 一文中提出，在障礙處定義一個(gè)排斥勢場，在目標(biāo)點(diǎn)出定義ー個(gè)吸弓I勢場，機(jī)械臂的運(yùn)動(dòng)就由排斥勢場和吸弓I勢場的共同作用來決定，該方法在處理全局路徑規(guī)劃的動(dòng)態(tài)避障問題時(shí)，非常有效，但易于陷入局部最小點(diǎn)處。申請?zhí)枮?01110037726. 9的專利中，描述了一種用于エ業(yè)機(jī)器人的無碰撞軌跡規(guī)劃的方法，該方法將整個(gè)笛卡爾空間劃分成三個(gè)部分，障礙物區(qū)域，無碰撞區(qū)域和發(fā)生碰撞的區(qū)域，每個(gè)區(qū)域用一個(gè)或多個(gè)圓柱形空間描述，機(jī)械臂的軌跡僅在無碰撞區(qū)域進(jìn)行規(guī)劃，可見這種方法沒有從根本上解決碰撞問題。

發(fā)明內(nèi)容
本發(fā)明的目的在于針對(duì)現(xiàn)有技術(shù)的不足，提供了一種仿人機(jī)器人機(jī)械臂避碰運(yùn)動(dòng)軌跡規(guī)劃方法。本發(fā)明適用于具有七個(gè)自由度的機(jī)械臂，其七個(gè)關(guān)節(jié)角分別為肩俯仰角、肩滾動(dòng)角、肩偏擺角、肘滾動(dòng)角、肘偏擺角、腕滾動(dòng)角和腕俯仰角。并且，固定機(jī)械臂從初始位姿到目標(biāo)位姿的運(yùn)動(dòng)時(shí)間為I從目標(biāo)位姿返回初始位姿的時(shí)間為Λ。本發(fā)明ー種仿人機(jī)器人機(jī)械臂避碰運(yùn)動(dòng)軌跡規(guī)劃方法包括以下步驟
步驟ー根據(jù)桌面與機(jī)器人的相對(duì)位置，對(duì)桌子進(jìn)行建摸。在笛卡爾空間下，以機(jī)器人肩心為世界坐標(biāo)系，將桌子模型建立為ー個(gè)平面以下的區(qū)域。步驟ニ 碰撞檢測及分類。
為了滿足實(shí)時(shí)性要求，將笛卡爾空間描述的初始位姿和目標(biāo)任務(wù)位姿轉(zhuǎn)換成關(guān)節(jié)空間的初始關(guān)節(jié)角序列和目標(biāo)關(guān)節(jié)角序列，在關(guān)節(jié)空間下采用矩形函數(shù)加速度法對(duì)各個(gè)關(guān)節(jié)角進(jìn)行插補(bǔ)，生成關(guān)節(jié)空間下的軌跡，然后對(duì)這條軌跡進(jìn)行正運(yùn)動(dòng)學(xué)運(yùn)算得到笛卡爾空間的軌跡，如果機(jī)械臂采用這條軌跡完成動(dòng)作的過程中，整條機(jī)械臂都未經(jīng)過桌子所在的區(qū)域，說明機(jī)械臂此次運(yùn)動(dòng)沒有與桌子發(fā)生碰撞，則采用該關(guān)節(jié)空間的軌跡控制機(jī)械臂完成任務(wù)。否則若機(jī)械臂的軌跡與桌面模型有交集，則可確定機(jī)械臂在此次任務(wù)中與桌面發(fā)生了碰撞，需要對(duì)機(jī)械臂的軌跡進(jìn)行處理，然后再完成動(dòng)作。此時(shí)需要根據(jù)發(fā)生碰撞的時(shí)刻Γ區(qū)分碰撞的三種情況(I)『,初始位姿到目標(biāo)位姿的運(yùn)動(dòng)過程發(fā)生碰撞，返回過程未發(fā)生碰撞；(2) Γ ,初始位姿到目標(biāo)位姿的運(yùn)動(dòng)過程未發(fā)生碰撞，返回初始位姿的過程發(fā)生碰撞；(3)以上兩種碰撞都發(fā)生了，即初始位姿到目標(biāo)位姿的運(yùn)動(dòng)過程和返回過程都發(fā)生碰撞。步驟三計(jì)算肘滾動(dòng)角的“臨界值”，井根據(jù)該臨界值調(diào)整肘滾動(dòng)角的軌跡，避免發(fā)
生碰撞O針對(duì)發(fā)生碰撞的情況，在碰撞的時(shí)刻使機(jī)械臂的肘部適當(dāng)?shù)膹澢敝羷偤貌慌c桌面發(fā)生碰撞，即在碰撞時(shí)刻對(duì)造成機(jī)械臂與桌面碰撞影響最顯著的位于肘部的肘滾動(dòng)角的值進(jìn)行修改，使得修改后得到的肘滾動(dòng)角的“臨界值”，結(jié)合肩俯仰角、肩滾動(dòng)角、肩偏擺角、肘偏擺角、腕滾動(dòng)角和腕俯仰角的值形成的機(jī)械臂的構(gòu)型，剛好不與桌面碰撞。肘滾動(dòng)角臨界值的求解步驟第一歩，根據(jù)碰撞時(shí)刻肩俯仰角、肩滾動(dòng)角、肩偏擺角、肘偏擺角、腕滾動(dòng)角和腕俯仰角的值以及假設(shè)ー個(gè)肘滾動(dòng)角的初始值，計(jì)算機(jī)械臂的正運(yùn)動(dòng)學(xué)即可得到肘關(guān)節(jié)方向向量的兩個(gè)頂點(diǎn)A、B及機(jī)械臂上的ー個(gè)檢
測點(diǎn)C的坐標(biāo)分別為A ( , )，B ( , , ) , C ( - . ),并計(jì)算此時(shí)肘關(guān)節(jié)的方
向向量AB ;第二歩，計(jì)算過點(diǎn)C且垂直于肘關(guān)節(jié)方向向量AB的平面L，可得其方程為
(>■ -^3)( -ろ)+ O -ァ3)(Λ - ) + (z-2s)(z2 -ζι) = 0 ;第三步，計(jì)算肘關(guān)節(jié)方向向量AB與上
一歩得到的平面L的交點(diǎn)0( ,J0,)，以此交點(diǎn)ο為球心，以點(diǎn)ο到點(diǎn)c的距離||cc||為半徑的球面方程 Ψ，其表達(dá)式為(x~xo)2 +(J->'ο)2 +(ζ~ζη)2 = (x3- xo)2 + OfS~λ)2 + ( ~zo)2 ；第四步，求該球面Ψ、第二步的平面L以及桌面的交點(diǎn)D ( ,ヌ4，24 );第五步，計(jì)算ZCOD，并用右手定則判斷ZCOZ)正負(fù)得到的值設(shè)為,然后計(jì)算機(jī)械臂與桌面發(fā)生碰撞時(shí)肘滾動(dòng)角的值，設(shè)為？4& 麗ゴ，則勵(lì)i = 90+Ag4 ,最后在基礎(chǔ)上增加一定余量，即可得到肘滾動(dòng)角的臨界值。取該碰撞時(shí)刻和該時(shí)刻肘滾動(dòng)角的臨界值作為ー個(gè)中間狀態(tài)，以及機(jī)械臂在初始時(shí)刻的肘滾動(dòng)角為其初始狀態(tài)和在目標(biāo)時(shí)刻的肘滾動(dòng)角為目標(biāo)狀態(tài)，將肘滾動(dòng)角的軌跡進(jìn)行分段生成。則如果發(fā)生第(I)種碰撞，三段軌跡分別為初始狀態(tài)到中間狀態(tài)，中間狀態(tài)到目標(biāo)狀態(tài)，目標(biāo)狀態(tài)返回初始狀態(tài)；如果發(fā)生第(2)種碰撞，三段軌跡為初始狀態(tài)到目標(biāo)狀態(tài)，目標(biāo)狀態(tài)到中間狀態(tài)，中間狀態(tài)返回初始狀態(tài)；如果發(fā)生第(3)種碰撞，說明機(jī)械臂運(yùn)動(dòng)過程中，共需要處理與桌面發(fā)生的兩次碰撞，三段軌跡為初始狀態(tài)到第一次避碰的中間狀態(tài)，第一次碰撞的中間狀態(tài)到第二次碰撞的中間狀態(tài)，第二次碰撞的中間狀態(tài)返回初始狀態(tài)。本發(fā)明的有益效果是本方案采用關(guān)節(jié)空間的軌跡規(guī)劃方法，對(duì)手臂各個(gè)關(guān)節(jié)分別進(jìn)行軌跡插補(bǔ)，在充分發(fā)揮各電機(jī)的性能、滿足關(guān)節(jié)限幅的要求、避免出現(xiàn)奇異位形的同吋，實(shí)現(xiàn)機(jī)械臂與桌面的避碰。達(dá)到提高機(jī)械臂完成任務(wù)的成功率和擴(kuò)大作業(yè)空間的目的。


圖I為機(jī)械臂各 關(guān)節(jié)的軸向方向及相關(guān)坐標(biāo)系的建立方法；
圖2為矩形加速度函數(shù)軌跡規(guī)劃法中加速度曲線 圖3為矩形加速度函數(shù)軌跡規(guī)劃法中速度曲線 圖4為矩形加速度函數(shù)軌跡規(guī)劃法中位移曲線 圖5為機(jī)械臂的ー組擊球位姿下的構(gòu)型；
圖6為求擊球過程中間點(diǎn)的流程 圖7求解返回過程中間點(diǎn)的流程圖。
具體實(shí)施例方式以下結(jié)合附圖對(duì)本發(fā)明作進(jìn)ー步說明。步驟ー根據(jù)桌面與機(jī)器人的相對(duì)位置，對(duì)桌面進(jìn)行建摸。如圖I所示，為ー個(gè)仿人機(jī)器人右機(jī)械臂的簡單模型，其中為其各個(gè)關(guān)
節(jié)的軸向方向向量，為世界坐標(biāo)系，( ,乃，ろM = I 7為各關(guān)節(jié)的局部坐標(biāo)系。在世界坐標(biāo)系下，將桌子建立成ー個(gè)平面以下的區(qū)域。即根據(jù)桌面高度和肩心高度，可以計(jì)算桌面所在平面在世界坐標(biāo)系下的描述為z。步驟ニ 碰撞檢測及分類。將笛卡爾空間的初始位姿及目標(biāo)位姿轉(zhuǎn)換成關(guān)節(jié)空間下的初始關(guān)節(jié)角序列和目標(biāo)關(guān)節(jié)角序列，采用矩形加速度函數(shù)規(guī)劃法生成機(jī)械臂在關(guān)節(jié)空間的軌跡，顧名思義，矩形加速度函數(shù)規(guī)劃法即加速度函數(shù)的曲線為矩形，如圖2所示，然后對(duì)加速度進(jìn)行積分得到速度曲線，如圖3所示，在對(duì)速度函數(shù)積分得到位移曲線，如圖4所示；然后進(jìn)行正運(yùn)動(dòng)學(xué)計(jì)算，將該軌跡轉(zhuǎn)換成笛卡爾空間的軌跡。若機(jī)械臂沿該運(yùn)動(dòng)軌跡運(yùn)動(dòng)時(shí)，機(jī)械臂上的檢測點(diǎn)的軌跡與步驟一中所建立的桌子模型沒有交集，說明機(jī)械臂未與桌面發(fā)生碰撞，則采用關(guān)節(jié)空間的軌跡控制機(jī)械臂完成任務(wù)。否則，根據(jù)發(fā)生碰撞的時(shí)刻Γ，區(qū)分發(fā)生碰撞的類型(1) Tift,初始位姿到目標(biāo)位姿的運(yùn)動(dòng)過程發(fā)生碰撞，返回過程未發(fā)生碰撞；(2)坑 ft +ra ,初始位姿到目標(biāo)位姿的運(yùn)動(dòng)過程未發(fā)生碰撞，返回初始位姿的過程發(fā)生碰撞；(3)以上兩種碰撞都發(fā)生了，即兩個(gè)發(fā)生碰撞的時(shí)刻為5和5，且F1 ξζ ,^<T, + ，初始位姿到目標(biāo)位姿的運(yùn)動(dòng)過程和返回過程都發(fā)生碰撞。步驟三調(diào)整肘滾動(dòng)角的軌跡，避免發(fā)生碰撞。針對(duì)上述步驟ニ中提到的發(fā)生碰撞的三種情況，對(duì)造成機(jī)械臂與桌面碰撞影響最顯著的肘滾動(dòng)角的軌跡進(jìn)行處理后再控制機(jī)械臂的運(yùn)動(dòng)。具體處理方法如下①發(fā)生情況(I)的碰撞，記錄碰撞發(fā)生的時(shí)刻Γ。此時(shí)已知條件為由矩形加速度函數(shù)法得到的其余六個(gè)關(guān)節(jié)角在該時(shí)刻的值以及機(jī)械臂與桌面的相對(duì)位置，將這些已知條件計(jì)算該時(shí)刻肘滾動(dòng)角的ー個(gè)臨界值，這個(gè)“臨界值”是指肘滾動(dòng)角取該值時(shí)，結(jié)合由一般軌跡插補(bǔ)方法得到的Γ時(shí)刻其余六個(gè)關(guān)節(jié)角的值，組成的七個(gè)關(guān)節(jié)角序列，使得此時(shí)刻采用此關(guān)節(jié)序列得到的機(jī)械臂構(gòu)型，不與桌面發(fā)生碰撞。肘滾動(dòng)角的臨界值的計(jì)算過程如下如圖5所示，點(diǎn)Α’是機(jī)械臂豎直狀態(tài)下肘關(guān)節(jié)點(diǎn)，點(diǎn)B’是機(jī)械臂豎直狀態(tài)下肘滾動(dòng)角的軸向向量的頂點(diǎn)，假設(shè)ー個(gè)機(jī)械臂姿態(tài)肘滾動(dòng)角初值選為90度，且其余六個(gè)關(guān)節(jié)角的值分別取碰撞時(shí)刻的六個(gè)值。點(diǎn)A是該姿態(tài)下肘關(guān)節(jié)點(diǎn)，點(diǎn)B是該姿態(tài)下肘滾動(dòng)角的軸向向量的頂點(diǎn)，點(diǎn)C為所取的取得機(jī)械臂末端執(zhí)行器的邊沿檢測點(diǎn)之一，平面L為過點(diǎn)C且垂
直于向量AB的平面，D點(diǎn)為肘關(guān)節(jié)在90度基礎(chǔ)上轉(zhuǎn)動(dòng)一定角度(繞ち逆時(shí)針轉(zhuǎn)為正，順時(shí)針轉(zhuǎn)為負(fù))后與桌面發(fā)生碰撞的碰撞點(diǎn)。可見，肘關(guān)節(jié)角取值為M)+s;gn(z；CD￡))時(shí)，機(jī)械臂剛好與桌子發(fā)生碰撞，從而可在90+s/p (ZCOZ))基礎(chǔ)上増大肘關(guān)節(jié)角的取值，即可避免碰撞。
根據(jù)肘滾動(dòng)角的初值90度，以及插補(bǔ)得到的Γ時(shí)刻其余六個(gè)關(guān)節(jié)角的值，計(jì)算機(jī)械臂的正運(yùn)動(dòng)學(xué)即可得到A、B、C三點(diǎn)的坐標(biāo)A 乃, )，B ( , , ) , C ( . - )。從而可得平面L的描述方程為
權(quán)利要求
1.仿人機(jī)器人機(jī)械臂避碰運(yùn)動(dòng)軌跡規(guī)劃方法，其特征在于該方法包括以下步驟 步驟ー根據(jù)桌面與機(jī)器人的相對(duì)位置，對(duì)桌子進(jìn)行建模 在笛卡爾空間下，以機(jī)器人肩心為世界坐標(biāo)系，將桌子模型建立為ー個(gè)平面以下的區(qū)域； 步驟ニ 碰撞檢測及分類 為了滿足實(shí)時(shí)性要求，將笛卡爾空間描述的初始位姿和目標(biāo)任務(wù)位姿轉(zhuǎn)換成關(guān)節(jié)空間的初始關(guān)節(jié)角序列和目標(biāo)關(guān)節(jié)角序列，在關(guān)節(jié)空間下采用矩形函數(shù)加速度法對(duì)各個(gè)關(guān)節(jié)角進(jìn)行插補(bǔ)，生成關(guān)節(jié)空間下的軌跡，然后對(duì)這條軌跡進(jìn)行正運(yùn)動(dòng)學(xué)運(yùn)算得到笛卡爾空間的軌跡，如果機(jī)械臂采用這條軌跡完成動(dòng)作的過程中，整條機(jī)械臂都未經(jīng)過桌子所在的區(qū)域，說明機(jī)械臂此次運(yùn)動(dòng)沒有與桌子發(fā)生碰撞，則采用該關(guān)節(jié)空間的軌跡控制機(jī)械臂完成任務(wù)，否則若機(jī)械臂的軌跡與桌面模型有交集，則可確定機(jī)械臂在此次任務(wù)中與桌面發(fā)生了碰撞，需要對(duì)機(jī)械臂的軌跡進(jìn)行處理，然后再完成動(dòng)作，此時(shí)需要根據(jù)發(fā)生碰撞的時(shí)刻 Γ區(qū)分碰撞的三種情況(I)，初始位姿到目標(biāo)位姿的運(yùn)動(dòng)過程發(fā)生碰撞，返回過程未發(fā)生碰撞；(2) If1 ,初始位姿到目標(biāo)位姿的運(yùn)動(dòng)過程未發(fā)生碰撞，返回初始位姿的過程發(fā)生碰撞；(3)以上兩種碰撞都發(fā)生了，即初始位姿到目標(biāo)位姿的運(yùn)動(dòng)過程和返回過程都發(fā)生碰撞； 步驟三計(jì)算肘滾動(dòng)角的“臨界值”，井根據(jù)該臨界值調(diào)整肘滾動(dòng)角的軌跡，避免發(fā)生碰撞 針對(duì)發(fā)生碰撞的情況，在碰撞的時(shí)刻使機(jī)械臂的肘部適當(dāng)?shù)膹澢敝羷偤貌慌c桌面發(fā)生碰撞，即在碰撞時(shí)刻對(duì)造成機(jī)械臂與桌面碰撞影響最顯著的位于肘部的肘滾動(dòng)角的值進(jìn)行修改，使得修改后得到的肘滾動(dòng)角的“臨界值”，結(jié)合肩俯仰角、肩滾動(dòng)角、肩偏擺角、肘偏擺角、腕滾動(dòng)角和腕俯仰角的值形成的機(jī)械臂的構(gòu)型，剛好不與桌面碰撞，肘滾動(dòng)角臨界值的求解步驟第一歩，根據(jù)碰撞時(shí)刻肩俯仰角、肩滾動(dòng)角、肩偏擺角、肘偏擺角、腕滾動(dòng)角和腕俯仰角的值以及假設(shè)ー個(gè)肘滾動(dòng)角的初始值，計(jì)算機(jī)械臂的正運(yùn)動(dòng)學(xué)即可得到肘關(guān)節(jié)方向向量的兩個(gè)頂點(diǎn)A、B及機(jī)械臂上的一個(gè)檢測點(diǎn)C的坐標(biāo)分別為A ( ッ1, ) ,B ( , , )，C ( , , ),并計(jì)算此時(shí)肘關(guān)節(jié)的方向向量AB ;第二歩，計(jì)算過點(diǎn)C且垂直于肘關(guān)節(jié)方向向量 AB 的平面 L，可得其方程為(x-x3Xx2 — ^i)+ (Ji-J3)O72 +—ろ)=O;第三歩，計(jì)算肘關(guān)節(jié)方向向量AB與上一歩得到的平面L的交點(diǎn)O (￥M),以此交點(diǎn)O為球心，以點(diǎn)O到點(diǎn)C的距離||OC|為半徑的球面方程Ψ，其表達(dá)式為￠^- )2 +(y_ Jo)2 +(β-ζ0)2 = ( — xO)2 + 0 — JjO)2 + (Z3 - z0.y ;第四步，求該球面 Ψ、第二步的平面L以及桌面的交點(diǎn)D ( , , );第五步,計(jì)算ZCOD ,并用右手定則判斷ZCDD正負(fù)得到的值設(shè)為,然后計(jì)算機(jī)械臂與桌面發(fā)生碰撞時(shí)肘滾動(dòng)角的值，設(shè)為04&31 ゴ，^llJqAbound = 90+Ag4，最后在基礎(chǔ)上增加一定余量，即可得到肘滾動(dòng)角的臨界值； 取該碰撞時(shí)刻和該時(shí)刻肘滾動(dòng)角的臨界值作為ー個(gè)中間狀態(tài)，以及機(jī)械臂在初始時(shí)刻的肘滾動(dòng)角為其初始狀態(tài)和在目標(biāo)時(shí)刻的肘滾動(dòng)角為目標(biāo)狀態(tài)，將肘滾動(dòng)角的軌跡進(jìn)行分段生成，則如果發(fā)生第(I)種碰撞，三段軌跡分別為初始狀態(tài)到中間狀態(tài)，中間狀態(tài)到目標(biāo)狀態(tài)，目標(biāo)狀態(tài)返回初始狀態(tài)；如果發(fā)生第(2)種碰撞,三段軌跡為初始狀態(tài)到目標(biāo)狀態(tài)，目標(biāo)狀態(tài)到中間狀態(tài)，中間狀態(tài)返回初始狀態(tài)；如果發(fā)生第(3)種碰撞，說明機(jī)械臂運(yùn)動(dòng)過程中，共需要處理與桌面發(fā)生的兩次碰撞，三段軌跡 為初始狀態(tài)到第一次避碰的中間狀態(tài)，第一次碰撞的中間狀態(tài)到第二次碰撞的中間狀態(tài)，第二次碰撞的中間狀態(tài)返回初始狀態(tài)。
全文摘要
本發(fā)明提出了一種仿人機(jī)器人機(jī)械臂避碰運(yùn)動(dòng)軌跡規(guī)劃方法，現(xiàn)有技術(shù)沒有從根本上解決碰撞問題，本發(fā)明采用基于關(guān)節(jié)空間插補(bǔ)方法生成機(jī)械臂運(yùn)動(dòng)軌跡所帶來的機(jī)械臂與桌子碰撞的問題，主要針對(duì)仿人機(jī)器人的擬人手臂面向桌面或類似桌面物體的作業(yè)，其中機(jī)械臂的自由度分布為肩部三個(gè)自由度，肘部兩個(gè)自由度，腕部兩個(gè)自由度。具體實(shí)現(xiàn)方法是，在能夠保證固定時(shí)刻完成目標(biāo)作業(yè)的前提下，在手臂運(yùn)動(dòng)過程中發(fā)生碰撞的時(shí)刻點(diǎn)，讓肘部適當(dāng)彎曲，避免碰撞。這種方案使機(jī)械臂實(shí)現(xiàn)了在具有較高的靈活性和較大作業(yè)空間的同時(shí)，無碰撞的運(yùn)動(dòng)。
文檔編號(hào)G06F17/50GK102646148SQ20121012378
公開日2012年8月22日 申請日期2012年4月25日 優(yōu)先權(quán)日2012年4月25日
發(fā)明者吳俊 , 張斌, 熊蓉, 黃秋蘭 申請人:浙江大學(xué)