Delta機器人關節(jié)空間軌跡規(guī)劃法|加工中心
3.4Delta機器人關節(jié)空間軌跡規(guī)劃法研究發(fā)現,，在機器人的軌跡規(guī)劃中加入動力學模型進行軌跡優(yōu)化,，得到的運動控制擬合曲線能夠極大地提高機器人的運行速度和穩(wěn)定性。由于運動學與動力學模型相結合的軌跡規(guī)劃是基于理想系統(tǒng)模型的分析,，所以不會增加系統(tǒng)的硬件成本，它是快速,、高效提高系統(tǒng)性能的一個有效手段,，在Delta機器人的軌跡規(guī)劃中，將會把動力學模型加入到軌跡規(guī)劃中來,。具體實現如下：建立系統(tǒng)的運動學模型和動力學模型,；根據Delta機器人的運行軌跡要求進行軌跡規(guī)劃,；針對優(yōu)化目標（運行速度、關鍵部件受力等）實現軌跡優(yōu)化,。3.4.1工作空間關鍵點的選取在Delta機器人的運行過程中,，不僅要抓取和釋放物體，還要避開障礙物,。為了實現抓取,、釋放以及中間轉運階段中，物體始終保持在末端執(zhí)行器上,，抓取和釋放物體階段要保證末端執(zhí)行器平穩(wěn),，對于Delta機器人而言，要盡量減小末端執(zhí)行器水平方向的抖動,，并且在豎直方向應實現平穩(wěn)的加減速,；在中間轉運階段中，應增大末端執(zhí)行器的拐彎半徑,，并且在水平擬合曲線段,，應盡量減小豎直方向的抖動，水平加減速應平穩(wěn),。這樣就必須確定物體抓取,、釋放的位置以及末端執(zhí)行器經過的空間軌跡關鍵點。在關節(jié)空間的軌跡規(guī)劃中,，分別選取了8,、9、11個工作空間關鍵點,，由8,、11個工作空間關鍵點擬合得到的工作空間內的擬合曲線如圖3-9所示。如圖可知,，由8個工作空間關鍵點擬合得到的工作空間內的擬合曲線有較大的拐彎半徑,，中間轉運階段擬合曲線豎直方向抖動較小，但抓取和釋放物體時水平方向的抖動較大,，可能會引起抓取和釋放物體位置不準確以及抓取和釋放過程中物體抖動,，抖動較大時物體甚至脫離末端執(zhí)行器。觀察發(fā)現,，在8個工作空間關鍵點的豎直抓取和釋放階段中,，擁有3個工作空間關鍵點的豎直方向的擬合曲線比擁有2個工作空間關鍵點的豎直方向的擬合曲線水平方向的抖動更小，由此,，得到了3個工作空間關鍵點確定一條抖動較小的直線段的結論,。為了改善8個工作空間關鍵點存在的缺點，采用9個工作空間關鍵點進行曲線擬合,，由得到的工作空間的擬合曲線知（圖中未表示）,，由9個工作空間關鍵點擬合得到的工作空間內的擬合曲線水平方向的抖動較8個工作空間關鍵點擬合得到的工作空間內的擬合曲線水平方向的抖動有所減小,，同時，中間轉運階段擬合曲線豎直方向抖動也有所較小,，但拐彎半徑也較小,，拐彎過程沒有較好的曲線過渡，這將會使得末端執(zhí)行器拐彎困難,，過于剛性的拐彎會引起對機構的沖擊,，減少機器人的使用壽命，并可能會導致被抓取物體的破壞或脫落,。因此,，在抓取和釋放物體的豎直直線段部分和中間轉運階段的水平直線段部分各選取3個工作空間關鍵點，為了增加末端執(zhí)行器的拐彎半徑,，在兩個拐彎處各添加1個拐彎半徑控制關鍵點,，這樣就得到了由11個工作空間關鍵點擬合得到的工作空間內的擬合曲線。調節(jié)這2個工作空間拐彎半徑控制關鍵點的位置,，不僅可以增加或減小末端執(zhí)行器的拐彎半徑,，還可以增加或減小抓取和釋放物體階段末端執(zhí)行器的水平方向的抖動，于此同時,，減小或增加中間位置豎直方向的抖動,。根據Delta機器人的工作需求，應適量增加末端執(zhí)行器的拐彎半徑,，與此同時,，減小抓取和釋放物體時末端執(zhí)行器的水平方向的抖動。在圖3-9中,，由11個工作空間關鍵點的擬合曲線可知,，末端執(zhí)行器在抓取和釋放物體的豎直擬合曲線段水平方向的抖動較小，在中間轉運擬合曲線段豎直方向稍有抖動,，兩個拐彎半徑較大,。可知,，利用11個工作空間關鍵點得到的控制擬合曲線具有良好的物體抓取和釋放性能以及中間轉運性能,。3.4.2關節(jié)空間運動學五次樣條函數模型由以上分析可知，五次樣條函數可以得到單段連續(xù)可導的位移,、速度、加速度,、加加速度擬合曲線,，但多段擬合曲線之間連接處，只有位移是連續(xù)可導的,，速度連續(xù)不可導,，加速度,、加加速度等出現跳躍，如果能夠解決擬合曲線關鍵點連接處的跳躍問題,，就可以得到多段連續(xù)可導的位移,、速度、加速度,、加加速度擬合曲線,，這將非常有利于提尚Delta機器人的控制性能。該五次樣條函數數學模型如公式（3-6)所不,，其中/〇),，/(x)，/(x),，/(x),，/(x)，分別表示關節(jié)空間內關節(jié)角位移,、速度,、加速度、加加速度以及加加速度的一階導數,，x表示每段擬合曲線段首尾的時間差,。為了使每段關節(jié)空間內關節(jié)角位移、速度,、加速度,、加加速度的擬合曲線在關鍵點連接處連續(xù)可導，需要建立合理的邊界條件,。Delta兩自由度高速并聯工業(yè)機器人有兩個驅動關節(jié)輸入量,，現只對左驅動關節(jié)的邊界條件進行闡述，右驅動關節(jié)的邊界條件與左驅動關節(jié)相同,，不同之處在于,，由11個工作空間關鍵點經過運動學逆解轉換得到的關節(jié)空間內的11關鍵點的數值不同。根據已經給定的左驅動關節(jié)的已知量和每段擬合曲線的邊界條件建立如下方程式,。擬合曲線0獨有方程式：系數矩陣Ai/rW,通過計算得到了左驅動關節(jié)擬合曲線的系數矩陣A,即得到了左驅動關節(jié)從關鍵點0到關鍵點10的擬合曲線,，同理可得到左驅動關節(jié)從關鍵點10到關鍵點0的擬合曲線，右驅動關節(jié)的曲線擬合方法與左驅動關節(jié)類似,，這里不再贅述,。3.4.3動力學軌跡優(yōu)化模型在第一章緒論中己經提到了同濟大學的李萬莉等人，采用五次樣條函數對機器人進行軌跡規(guī)劃,，但其約束條件過多,，導致了關鍵點連接處擬合曲線的速度、加速度,、加加速度不可導的問題,，上一小節(jié)的“運動學五次樣條函數模型”已經成功解決了這一問題,，但李萬莉等人的軌跡規(guī)劃還存在一些缺點，也是很多軌跡規(guī)劃論文存在的問題,，即沒有進行動力學的軌跡優(yōu)化,，這樣會導致一個工作循環(huán)內驅動電機力矩、功率的峰值大小相差較大,，在驅動電機確定的情況下,，這將不利于提高機器人的運行速度和精度，換句話說,，驅動電機的動力學性能沒有完全的發(fā)揮出來,。為了使得Delta機器人具有良好的動力學性能，在Delta機器人軌跡規(guī)劃過程中,，加入了第二章所述的動力學模型,。將動力學模型加入到軌跡規(guī)劃中的主要目的是，在不改變機器人機械結構尺寸的情況下,，盡量降低機器人所需驅動電機的力矩和功率,。這樣，在不更換己有驅動電機的情況下,，就可以提高機器人整體的運行速度和精度,。公式（3-12)說明了，外力矩是驅動關節(jié)角位移,、速度和加速度的函數,。因為/(x),/(x),/(x)是時間的函數，由此,，推導出廣義關節(jié)作用力r和功率/^也是時間的函數,公式（3-12)是驅動力矩的動力學時間方程,。在得到動力學的時間方程后，選擇關節(jié)空間內角速度（一個工作循環(huán)的時間作為動力學的優(yōu)化目標,。進行動力學軌跡優(yōu)化的目標有兩個：一是在不增加驅動力矩和功率的情況下,，盡量縮短一個工作循環(huán)的周期，即驅動電機確定,，盡量增加機器人的運行速度,；二是在不改變一個工作循環(huán)周期的情況下，盡量降低驅動力矩和功率,，即在機器人的運行速度不變的情況下,，盡量降低所需驅動電機的力矩和功率。在大多數情況下,，純粹對時間周期的優(yōu)化幾乎不能求解,，因此，將時間周期設為常數1,即機器人運行一個循環(huán)所需時間是1秒鐘，并將驅動電機的力矩和功率作為動力學優(yōu)化的目標,。一般情況下，功率的優(yōu)化和力矩的優(yōu)化是互相矛盾的,，即將力矩優(yōu)化到******數值,，可能會導致功率過大；反之,，將功率優(yōu)化到******數值,，可能會導致力矩過大。在進行驅動電機力矩和功率的動力學優(yōu)化時,，需要結合實際的電機參數選取力矩占優(yōu)還是功率占優(yōu)的方式進行動力學優(yōu)化,，并且，在動力學優(yōu)化過程中,，電機的力矩占優(yōu)還是功率占優(yōu)是不斷變化的,。例如，當機器人開始運行時,，由于驅動電機的速度很小,，導致驅動電機的功率很小，相反,，為了提高機器人的運行速度,、減小每次循環(huán)的時間周期，機器人的驅動電機將以較大的峰值力矩啟動,，這時驅動電機的峰值力矩將作為動力學優(yōu)化的主要目標,，即應盡量減小機器人開始運行時的峰值力矩，并使得力矩維持在峰值,；當機器人高速運行時,，由于驅動電機的速度很高，導致驅動電機的功率很大,，此時,，驅動電機的力矩可能會較小，為了提高機器人的運行速度,，此時,，驅動電機的功率將作為動力學優(yōu)化的主要目標，即應盡量減小驅動電機的峰值功率,，并使得機器人高速運行時,，驅動電機的輸出功率基本維持在峰值。Delta機器人軌跡規(guī)劃流程如圖3-10所示,，其中,，判斷1為得到的關節(jié)空間內擬合曲線的關節(jié)角位移、速度是否沒有過沖，速度,、加速度,、加加速度擬合曲線峰值是否相差較小,；判斷2為得到的關節(jié)驅動力矩峰值和功率峰值是否相差較小,，為了充分利用驅動電機的性能，應盡量降低每個擬合曲線段內的關節(jié)驅動力矩或驅動功率的峰值,，并盡量使驅動力矩或驅動功率維持在峰值附近,。以上判別量都是時間的函數，修改每段擬合曲線的時間即可對運動學和動力學的擬合曲線進行整體優(yōu)化,。3.4.4軌跡規(guī)劃曲線分析根據關節(jié)空間內Delta機器人的運動學五次樣條函數模型和動力學的軌跡優(yōu)化模型,，編寫機器人的Python軌跡規(guī)劃程序，得到的擬合曲線如圖3-11,3-12,3-13所示,。圖3-11中,，左右紅色和綠色擬合曲線分別為左驅動關節(jié)和右驅動關節(jié)運動學擬合曲線，由上至下分別表示驅動關節(jié)角位移,、速度,、加速度和加加速度擬合曲線，由圖可以看出,，利用以上運動學五次樣條函數模型和動力學軌跡優(yōu)化模型,，得到的Delta機器人的關節(jié)空間內擬合曲線的角位移、速度,、加速度和加加速度擬合曲線均連續(xù)可導,，遏制了由于擬合曲線跳躍而出現機器人振動，甚至共振現象的發(fā)生,。左右驅動關節(jié)的速度大小均小于8rad/■s■,，加速度大小均小于180rafif/5"2，加加速度大小均小于6000rad//,速度,、加速度,、加加速度峰值相差較小，得到的擬合曲線有利于Delta機器人實際控制,。圖3-12為關節(jié)空間擬合曲線通過運動學正解轉換到得到的工作空間擬合曲線,，左邊紅色擬合曲線由上至下分別為末端執(zhí)行器x方向的位移、速度,、加速度擬合曲線,，右邊綠色擬合曲線由上至下分別為末端執(zhí)行器y方向的位移、速度,、加速度擬合曲線,，從圖中可以看出，末端執(zhí)行器的位移、速度和加速度擬合曲線均連續(xù)可導,，可有效減小機器人末端執(zhí)行器的振動,，并提高其運行速度。末端執(zhí)行器x方向的速度,、加速度大小分別小于3.2m/x,、70m/?，并且,，x方向的速度有較長時間維持在峰值附近，這將非常有利于提高機器人的實際運行速度,；,；y方向的速度、加速度大小分別小于S.Om/s,、60mis1,。利用Delta機器人簡化的動力學模型，對機器人的運動學軌跡規(guī)劃擬合曲線進行相關動力學優(yōu)化,，降低所需驅動電機的峰值力矩和峰值功率,，力求每個驅動電機的峰值力矩、峰值功率大小分別趨于同一數值,，并使其維持在峰值附近是動力學優(yōu)化的最終目標,。參考使用的高精度交流伺服直驅力矩電機的基本參數，把力矩優(yōu)化作為動力學優(yōu)化的主要目標,，功率優(yōu)化作為動力學優(yōu)化的次要目標,。圖3-13為動力學優(yōu)化后的所需驅動電機力矩和功率擬合曲線，左側紅色擬合曲線由上至下分別為左驅動電機的力矩擬合曲線和功率擬合曲線,，由圖可以看出擬合曲線的峰值力矩大小小于70W*m,，峰值功率大小小于480vv;右側綠色擬合曲線由上至下分別為右驅動電機的力矩擬合曲線和功率擬合曲線，由圖中可以看出擬合曲線的峰值力矩大小小于80W_m,峰值功率大小小于500vv,。左右驅動電機的力矩擬合曲線均連續(xù)可導,，并且兩驅動電機的力矩峰值大小相差較小,；左右驅動電機的功率擬合曲線為取絕對值后得到的擬合曲線,，實際上，在取絕對值之前,左右驅動電機的功率擬合曲線也是連續(xù)可導的擬合曲線,，并且兩擬合曲線的峰值相差較小,，綠色右驅動電機的擬合曲線有較長時間維持在峰值附近，電機的功率得到了充分的利用,。本文采摘自“高速并聯工業(yè)機械手臂分析設計與實現”,，因為編輯困難導致有些函數、表格、圖片,、內容無法顯示,，有需要者可以在網絡中查找相關文章！本文由海天精工整理發(fā)表文章均來自網絡僅供學習參考,，轉載請注明,！