機床商務網技術文章
Copley驅動器運動參數讀取實驗
閱讀：99 發布時間：2020-8-12
4.6 Copley驅動器運動參數讀取實驗
由于Delta機器人使用的直驅力矩電機精度較高，其旋轉編碼器的精度高達 405000c〇Unt, —般的伺服驅動器難以達到如此高的控制精度，Copley驅動器是使用成熟 的一類高性能驅動器，其交流伺服驅動器體積緊湊、輸出功率大并滿足所需的高精度控 制要求，所以選擇了 Copley交流伺服驅動器對高精度直驅力矩電機進行PID控制。
為了對三種方法軌跡規劃程序結果的實際應用價值進行驗證，從驅動器中讀取了驅 動電機的實際運行參數，并與仿真結果進行對比。實驗中，物體釋放（時間為0.6S)處
沒有時間間隔，末端抓取物體質量約為1千克（實際抓取物體質量大于1千克），運行 速度60次/分。其中，紅色實線為仿真計算得到的擬合曲線，綠色實線為驅動器指令曲 線，黑色虛線為驅動電機實際運行曲線，紫紅色虛線為沒有末端物體質量時驅動電機實 際力矩曲線。
4.6.1關節空間軌跡規劃實驗參數讀取
圖4-4為關節空間軌跡規劃結果對機器人進行實際控制得到的位移-速度實驗曲線, 由圖可知，左右驅動電機實際位移跟隨仿真擬合曲線，左驅動電機在物體釋放位置（0.6S 附近）出現微小的位移過沖，在返回抓取位置時，左驅動電機有微小的欠位移；右驅動 電機在物體釋放位置出現微小的欠位移，在返回抓取位置時，右驅動電機出現微小的位 移過沖。左右驅動器速度指令曲線跟隨仿真擬合曲線并在其附近抖動，在返回抓取位置 時，左驅動電機速度指令曲線不為零，右驅動電機速度指令曲線出現過沖；左右驅動電 機實際速度曲線跟隨指令速度曲線，實際速度峰值大于仿真擬合曲線速度峰值，在返回 抓取位置時，右驅動電機實際速度曲線出現過沖。
圖4-5為關節空間軌跡規劃結果對機器人進行實際控制得到的驅動電機力矩實驗曲 線，選取仿真擬合曲線力矩峰值為80W.m。由圖可知，左右驅動電機實際力矩曲線與 指令力矩曲線重合，實際力矩曲線與擬合力矩曲線趨勢大體相同，在物體抓取階段（0 至0.1S附近），左右實際保持力矩均小于仿真擬合力矩峰值，在運行階段，左右實際力 矩峰值較仿真擬合力矩曲線峰值分別高出大約30A^m、lOA^.m，在返回抓取位置時， 左右實際力矩曲線均有不同程度的抖動，左右實際力矩峰值較未施加末端質量時的實際 力矩峰值高出大約60A^m、40A^m,可見末端執行器抓取物體質量對機器人驅動電機 的實際力矩曲線影響很大。
4.6.2工作空間軌跡規劃實驗參數讀取
圖4-6為工作空間軌跡規劃結果對機器人進行實際控制得到的位移-速度實驗曲線, 由圖可知，左右驅動電機實際位移跟隨仿真擬合曲線，部分位移曲線段跟隨性較差，左 驅動電機在物體釋放位置（0.6S附近）出現微小的位移過沖；右驅動電機在物體釋放位 置出現微小的欠位移，在返回抓取位置時，右驅動電機出現微小的位移過沖。左右驅動 器速度指令曲線與仿真擬合速度曲線有較大差距，左驅動電機速度指令曲線峰值大小與 擬合曲線速度峰值大小相差大約并且左驅動電機速度指令曲線與仿真擬合曲 線之間的跟隨性較差，在返回抓取位置時，左驅動電機速度指令曲線不為零；右驅動電 機速度指令曲線峰值大小與擬合曲線速度峰值大小相差大約并且右驅動電 機速度指令曲線有較大的抖動，與仿真擬合曲線之間的跟隨性較差，在返回抓取位置時, 右驅動電機速度指令曲線出現過沖。左右驅動電機實際速度曲線跟隨指令速度曲線，由于驅動電機性能及其負載限制，左驅動電機實際速度曲線峰值大小與指令速度曲線峰值 大小相差較大約為在返回抓取位置時，左驅動電機實際速度曲線不為零，右 驅動電機實際速度曲線出現過沖，左右驅動電機的實際速度曲線峰值大小均大于擬合曲 線速度峰值大小。
圖4-7為工作空間軌跡規劃結果對機器人進行實際控制得到的力矩實驗曲線，選取 仿真擬合曲線力矩峰值為lOOW.m。由圖可知，在物體抓取階段（0至0.1S附近），左 右實際保持力矩均小于仿真擬合保持力矩。在0.6S附近，由于驅動電機峰值力矩限制， 左驅動電機實際力矩曲線峰值不能達到指令力矩曲線峰值，并且，實際力矩曲線維持在 驅動電機力矩峰值，其余擬合曲線段，實際力矩曲線與指令力矩曲線重合，左實際力矩 曲線與擬合力矩曲線趨勢大體相同，但峰值力矩大小相差較大約為60W*m;右驅動電 機實際力矩曲線與指令力矩曲線重合，在0.6S至0.8S附近，實際力矩曲線抖動較大， 幾乎為整個運行周期的波峰和波谷，在此階段，實際力矩曲線性能較差，可能會引起機 器人手臂的自激振蕩，右實際力矩曲線與擬合力矩曲線趨勢有一定差距，并且，峰值力 矩大小相差較大約為45W.m。在返回抓取位置時，左右實際力矩曲線均有不同程度的抖動，左右買際力矩峰值大小較未施加末端質量時的買際力矩峰值大小尚出大約30 N • m、
圖4-8為混合空間軌跡規劃結果對機器人進行實際控制得到的位移-速度實驗曲線, 由圖可知，左右驅動電機實際位移曲線跟隨仿真擬合曲線，并且左右驅動電機的位移曲 線跟隨性均較好，左驅動電機在物體釋放位置（0.6S附近）出現微小的位移過沖，在返 回抓取位置時，左驅動電機有微小的欠位移；右驅動電機在物體釋放位置沒有出現欠位 移或位移過沖，在返回抓取位置時，右驅動電機有微小的位移過沖。左右驅動器速度指 令曲線跟隨仿真擬合曲線并稍有抖動，并且左右驅動電機的速度曲線跟隨性均較好，速 度指令曲線峰值大小與仿真擬合曲線速度峰值大小接近，在返回抓取位置時，左驅動電 機速度指令曲線不為零，右驅動電機速度指令曲線出現過沖；左右驅動電機實際速度曲 線跟隨指令速度曲線，實際速度峰值稍大于仿真擬合曲線速度峰值，并且，實際速度曲 線抖動較小，在返回抓取位置時，左右驅動電機實際速度曲線均出現不同程度的過沖。
圖4-9為混合空間軌跡規劃結果對機器人進行實際控制得到的力矩實驗曲線，選取 仿真擬合曲線力矩峰值為90W.m。由圖可知，左右驅動電機實際力矩曲線與指令力矩 曲線重合，實際力矩曲線與擬合力矩曲線趨勢大體相同，在物體抓取階段（0至0.1S附 近），左右實際保持力矩均小于仿真擬合力矩峰值，在運行階段，左實際力矩峰值較仿真 擬合力矩曲線峰值高約右實際力矩峰值與仿真擬合力矩曲線峰值大體相同， 在返回抓取位置時，左右實際力矩曲線均有不同程度的抖動，左右實際力矩峰值較未施 加末端質量時的實際力矩峰值高出大約40W.m、30W.m。
總結，關節空間和混合空間軌跡規劃結果對機器人進行實際控制，得到的實際位移 -速度曲線跟隨對應的仿真擬合曲線效果較好，而工作空間軌跡規劃結果對機器人進行 實際控制，得到的實際位移-速度曲線跟隨仿真擬合曲線效果相對較差，關節空間軌跡規 劃結果的實際控制角速度曲線峰值稍大于混合空間軌跡規劃結果的實際控制角速度曲 線峰值，工作空間軌跡規劃結果的實際控制角速度峰值大于其他兩種軌跡規劃結果的實 際控制角速度峰值。
關節空間和混合空間軌跡規劃結果對機器人進行實際控制，得到的實際力矩曲線峰 值相近，均小于工作空間軌跡規劃結果對機器人進行實際控制得到的實際力矩曲線峰值, 因此，關節空間和混合空間的軌跡規劃方法更有利于提高機器人的實際運行速度，并且， 工作空間軌跡規劃法得到的實際控制力矩曲線峰值達到了力矩電機的實際峰值力矩，甚 至，命令力矩曲線峰值超出了力矩電機的實際峰值力矩，相對于其他兩種軌跡規劃方法， 工作空間軌跡規劃方法不利于機器人的實際控制，實際測試結果與理論研宄結果相符。
對三種軌跡規劃結果得到的實際力矩進行分析可知，在0到0.1S的力矩保持階段， 實測力矩均小于仿真力矩，在機器人的運行階段，實測力矩均大于仿真力矩，分析誤差 主要有以下原因：
力矩曲線是根據Copley驅動器中電機驅動電流轉換得到，選取的力矩常數是該 電機的設計參數，與實際參數之間會有百分之十以內的誤差。
⑵機器人的動力學模型是簡化的動力學模型，省略了對驅動電機動力學參數影響 較小的桿件的轉動動能。
⑶機器人的動力學模型中，沒有考慮較為復雜的各關節之間的摩擦對所需驅動電 機動力學性能的影響。
⑷實驗過程中，機器人末端執行器抓取物體實際質量為1.075千克，大于理論計 算中的1千克。
由于加工和手工裝配等方面的誤差，手臂的實際質量應大于動力學模型中使用 的質量，并且實測的下端桿件的關節軸承軸心距稍大于設計尺寸。
由于手工裝配等方面的誤差，機構中兩個平行四桿機構并不能保證平行， 在機器人的高速運行過程中會存在內力損耗。
本文采摘自“高速并聯工業機械手臂分析設計與實現”，因為編輯困難導致有些函數、表格、圖片、內容無法顯示，有需要者可以在網絡中查找相關文章！本文由伯特利數控整理發表文章均來自網絡僅供學習參考，轉載請注明！