一種工業多軸機械臂的運動再現方法技術

本發明專利技術提供一種工業多軸機械臂的運動再現方法，所述方法需提供多軸機械臂、機械臂控制器、上位機以及工控機；利用工控機和以太網實現了上位機與機械臂控制器之間的數據通信；當多軸機械臂運行時，根據設置好的采樣周期，實時采集多軸機械臂運動過程中的運動參數，并將運動參數存儲到上位機中；當需要再現運動軌跡時，將記錄的運動參數根據記錄的順序和設置的數據復現周期，依次發送給機械臂控制器，控制完整再現整個作業過程。本發明專利技術解決現有工業多軸機械臂的運動再現方法對用戶專業要求高，不能精確再現示教中的運動軌跡、再現程序修改困難以及故障查找不方便的技術問題。

【技術實現步驟摘要】

本專利技術屬于工業機械臂運動控制
，尤其涉及一種工業多軸機械臂的運動再現方法。
技術介紹
基于機械臂示教編程器的示教再現是實現多軸機械臂運動再現最常用的方法。現在工業中應用的多軸機械臂大都具有示教再現功能，可重復再現通過示教編程存儲起來的作業程序。多軸機械臂系統的編程能力極大的決定了多軸機械臂使用功能的靈活性和智能程度。上述示教再現方法中，常見的問題有：(1)運動再現程序必須預先編制或示教，對多軸機械臂的操作者的專業知識要求比較高，為多軸機械臂應用領域的拓寬帶來阻礙；(2)當要更改再現程序時，用戶需要對作業程序進行修改甚至是重新編寫，這就要求用戶具備一定的編程知識，花費大量時間去學習編寫程序；(3)在示教過程中，往往需要采用特定的算法，根據記錄的示教點數據計算得到相應的運動軌跡，再發送給機械臂控制其運動，這只能保證所記錄示教點位姿的精度，卻無法精確復現示教點之間的運動軌跡，適用于點到點和不需要很精確路徑控制的場合；(4)在運動再現過程中，無法實時記錄機械臂運行的相關參數，不利于在故障排查時進行故障分析。現有技術中公開了“一種工業機器人示教再現方法”，見公開號為：103778843A，公開日為：2014-05-07的中國專利，該方法包括以下步驟：1、示教：2、再現：其中再現分為三種方式：2.1、當工業機器人末端運動為關節運動時：2.2、工業機器人末端運動為直線運動時：2.3、工業機器人末端運動為圓弧運動時分別說明，該專利技術提供了一種示教過程簡單、精確的示教再現方式。示教過程包括對示教點的記錄、機器人工作的附加信息和到每一
示教點的相應操作的記錄。本機型機器人的指令包括運動指令、邏輯指令、運算指令、工作指令和輔助指令。這些指令綜合起來可以完成預期的工作。該專利技術提供了三種機器人運動軌跡算法，并結合機器人示教點A和示教點B的運動參數(各軸轉動角度、各軸的位移以及機器人末端位姿)，通過分析計算得到三種不同的運動軌跡，再利用得到的運動軌跡控制機器人實現運動再現。該方法雖然能保證機器人示教點A和示教點B的位姿精度，但機器人運動過程的運動軌跡是由算法計算而成的，無法精確再現示教中的運動軌跡。而且該方法也不能對機器人運動再現過程中的運動參數進行實時記錄，故障復現難度大。
技術實現思路
本專利技術要解決的技術問題，在于提供一種工業多軸機械臂的運動再現方法，解決現有工業多軸機械臂的運動再現方法對用戶專業要求高，不能精確再現示教中的運動軌跡、再現程序修改困難以及故障查找不方便的技術問題。本專利技術是這樣實現的：一種工業多軸機械臂的運動再現方法，所述方法需提供多軸機械臂、機械臂控制器、上位機以及工控機；利用工控機和以太網實現了上位機與機械臂控制器之間的數據通信；當多軸機械臂運行時，根據設置好的采樣周期，實時采集多軸機械臂運動過程中的運動參數，并將運動參數存儲到上位機中；當需要再現運動軌跡時，將記錄的運動參數根據記錄的順序和設置的數據復現周期，依次發送給機械臂控制器，控制完整再現整個作業過程。進一步的，所述方法進一步包括：當多軸機械臂作業中發生故障后，將存儲在上位機中的所述運動參數依次發送給多軸機械臂，使其再現整個作業過程，便于用戶排查故障。進一步的，在多軸機械臂所有運動過程中，都能實時采集和保存多軸機械臂運動過程中的運動參數，所述運動參數包括：機械臂旋轉角度、末端位置數據、各軸角位移及角速度。進一步的，所述在多軸機械臂所有運動過程中，都能實時采集和保存多軸機械臂運動過程中的運動參數，具體為：在多軸機械臂運動過程中，根據設置的采樣周期，上位機通過組態軟件實時采集多軸機械臂，包括機械臂旋轉角度、末端位置數據、各軸角位移及角速度在內的運動參數，并將運動參數對應到相應的時間單元，依次存儲在上位機中；在多軸機械臂進行運動再現的過程中，也會根據設置的采樣周期，將機械臂的旋轉角度、末端位置數據和各軸角位移及角速度依次記錄并存儲至上位機中。進一步的，所述方法進一步包括：能在任意時間、任意狀態下，利用記錄在上位機中的歷史數據，快速再現機械臂任意時間段的三維運動過程，所再現的機械臂的初始狀態、最終狀態以及過程運動軌跡與再現機械臂任意時間段的三維運動過程的完全一致，具體實施步驟如下：在機械臂完成某一組動作后，上位機讀取上位機中存儲的相關運動參數，按照時間區域內時間單元的排列順序，依次將對應的機械臂轉動角度、末端位置、各軸角位移及角速度參數發送至機械臂控制器，控制機械臂各軸運動，從而完整再現機械臂完成某一組動作的運動過程，重復定位精度高；用戶也能僅選取該組動作所隸屬時間區域內的某個時間段，以控制機械臂再現該組動作中的某一個動作或多個動作，從而實現運動再現的靈活變化。進一步的，在運動再現時，通過調節數據復原刷新周期來實現運動歷史過程的加減速再現；具體實施步驟如下：當需要實現機器人某段運動歷史過程的加速或減速再現時，對數據復現周期進行更改，上位機將根據數據復現周期與采樣周期的比值，分別對數據傳輸的時間間隔和所記錄的各軸角速度進行等比例的放大和縮小；上位機按照變更后的數據傳輸時間間隔，依次將機械臂轉動角度、末端位置、各軸角位移及縮放后的角速度發送至機械臂控制器，控制機械臂各軸運動，從而實現運動歷史過程的加減速再現。進一步的，當多軸機械臂出現故障需要復現時，把存儲在上位機中的故障時間區域內的所述運動參數作為機械臂控制參數發送給機械臂控制器，控制機械臂再現整個故障過程；其具體步驟如下：步驟1、根據故障發生時間，選定需要進行運動再現的時間區域；步驟2、上位機將上位機中所存儲的所述故障時間區域內的運動參數，按照時間單元的排序依次發送給機械臂控制器；步驟3、機械臂控制器根據接收到的控制和運動參數，驅動機械臂再現作業過程，從而實現故障再現。本專利技術具有如下優點：1、本專利技術可以將多軸機械臂運動過程中的機械臂旋轉角度、末端位置數據、各軸角位移及角速度記錄下來，并存儲在上位機中，為研究多軸機械臂運動過程提供極大便利。2、本專利技術可以實現在任意時間、任意狀態下，完整再現多軸機械臂任意時間區域內的三維運動過程，且可確保再現精度。而且用戶無需具有編程基礎也能操作機械臂實現運動再現，操作過程簡單，工作效率高，從而有利于機器人在實際生產中的應用與推廣。3、在運動再現時，可以通過調節數據復原刷新周期來實現運動歷史過程的加減速復現，實現運動再現的多樣性，擴大機器人在實際生產中的運用范圍。4、在多軸機械臂發送故障后，可以調用故障發生時刻所屬時間區域的記錄數據，實現故障的完整復現，便于用戶進行故障診斷、修復和分析。附圖說明圖1為本專利技術方法流程示意圖。圖2為本專利技術涉及硬件的架構圖。圖3為本專利技術運動參數存儲流程圖。圖4為本專利技術運動再現流程圖。具體實施方式請參閱圖1至圖4所示，本專利技術的一種工業多軸機械臂的運動再現方法，
所述方法需提供多軸機械臂、機械臂控制器、上位機以及工控機；利用工控機和以太網實現了上位機與機械臂控制器之間的數據通信；當多軸機械臂運行時，根據設置好的采樣周期，實時采集多軸機械臂運動過程中的運動參數，并將運動參數存儲到上位機中；當需要再現運動軌跡時，將記錄的運動參數根據記錄的順序和設置的數據復現周期，依次發送給機械臂控制器，控制完整再現整個作業過程，可實現既定軌本文檔來自技高網...

【技術保護點】
一種工業多軸機械臂的運動再現方法，其特征在于：所述方法需提供多軸機械臂、機械臂控制器、上位機以及工控機；利用工控機和以太網實現了上位機與機械臂控制器之間的數據通信；當多軸機械臂運行時，根據設置好的采樣周期，實時采集多軸機械臂運動過程中的運動參數，并將運動參數存儲到上位機中；當需要再現運動軌跡時，將記錄的運動參數根據記錄的順序和設置的數據復現周期，依次發送給機械臂控制器，控制完整再現整個作業過程。

【技術特征摘要】
1.一種工業多軸機械臂的運動再現方法，其特征在于：所述方法需提供多軸機械臂、機械臂控制器、上位機以及工控機；利用工控機和以太網實現了上位機與機械臂控制器之間的數據通信；當多軸機械臂運行時，根據設置好的采樣周期，實時采集多軸機械臂運動過程中的運動參數，并將運動參數存儲到上位機中；當需要再現運動軌跡時，將記錄的運動參數根據記錄的順序和設置的數據復現周期，依次發送給機械臂控制器，控制完整再現整個作業過程。2.根據權利要求1所述的一種工業多軸機械臂的運動再現方法，其特征在于：所述方法進一步包括：當多軸機械臂作業中發生故障后，將存儲在上位機中的所述運動參數依次發送給多軸機械臂，使其再現整個作業過程，便于用戶排查故障。3.根據權利要求1所述的一種工業多軸機械臂的運動再現方法，其特征在于：在多軸機械臂所有運動過程中，都能實時采集和保存多軸機械臂運動過程中的運動參數，所述運動參數包括：機械臂旋轉角度、末端位置數據、各軸角位移及角速度。4.根據權利要求3所述的一種工業多軸機械臂的運動再現方法，其特征在于：所述在多軸機械臂所有運動過程中，都能實時采集和保存多軸機械臂運動過程中的運動參數，具體為：在多軸機械臂運動過程中，根據設置的采樣周期，上位機通過組態軟件實時采集多軸機械臂，包括機械臂旋轉角度、末端位置數據、各軸角位移及角速度在內的運動參數，并將運動參數對應到相應的時間單元，依次存儲在上位機中；在多軸機械臂進行運動再現的過程中，也會根據設置的采樣周期，將機械臂的旋轉角度、末端位置數據和各軸角位移及角速度依次記錄并存儲至上位機中。5.根據權利要求1所述的一種工業多軸機械臂的運動再現方法，其特
\t征在于：所述方法進一步包括：能在任意時間、任意狀態下，利用記錄在上位機中的歷史數據，快速再現機械臂任意時間段...

【專利技術屬性】
技術研發人員：鄭松，曾其鋆，李真真，何俊欣，何偉東，張望，王亮亮，
申請(專利權)人：愛普福建科技有限公司，
類型：發明
國別省市：福建;35