兩軸全自動高速點膠機器人伺服控制系統的製作方法

2023-05-04 18:42:26

專利名稱：兩軸全自動高速點膠機器人伺服控制系統的製作方法
技術領域：
本發明是有關於點膠機器人的技術領域，且特別是有關於兩軸全自動高速點膠機器人伺服控制系統。
背景技術：
在高技術迅猛發展的今天，傳統的生產方式已日趨落後，新型的自動化生產將成為新世紀接受市場挑戰的重要方式。自動化不僅是提高勞動生產率的手段，對企業未來的長遠發展戰略起著重要的作用。由於機器人是新型的自動化的主要工具，工業機器人及其應用工程的開發，將機器人變為直接生產力，它在改變傳統的生產模式，提高生產率及對市場的適應能力方面顯示出極大的優越性。同時它將人從惡劣危險的工作環境中替換出來，進行文明生產，這對促進經濟發展和社會進步都具有重大意義。隨著製造業對機器人裝備的需求及綠色環保和改善勞動者的工作環境要求越來越高，專門對流體進行控制，並將流體點 滴、塗覆於產品表面或產品內部的自動化機器點膠機器人隨即產生。點膠機器人主要用於產品工藝中的膠水、油漆以及其他液體精確點、注、塗、點滴到每個產品精確位置，可以用來實現打點、畫線、圓型或弧型。「點膠機器人」的研究開發將對我國製鞋行業、PCB板綁定封膠、IC封膠、PDA封膠、IXD封膠、IC封裝、IC粘接等行業產生巨大的經濟效益和社會效益。有的時候，點膠機器人只是需要反覆在一條直線上或者一個二維的平面上進行簡單的直線或圓弧塗膠或者是按照一定的規律對一些位置進行點對點的塗膠，這個時候一臺兩軸的點膠機器人可以很快的完成上述動作。一臺完整的兩軸點膠機器人大致分為以下幾個部分
O電機執行電機是點膠機器人的動力源，它根據微處理器的指令來執行點膠機器人在加工部件二維的平面上行走的相關動作；
2)算法算法是點膠機器人的靈魂，點膠機器人必須採用一定的智能算法才能準確快速的從一點到達另外一點，形成點對點，或曲線運動；
3)微處理器微處理器是點膠機器人的核心部分，是點膠機器人的大腦，點膠機器人所有的信息，包括膠點大小，位置信息，和電機狀態信息等都需要經過微處理器處理並做出相應的判斷。點膠機器人結合了多學科知識，對於提升在校學生的動手能力、團隊協作能力和創新能力，促進學生課堂知識的消化和擴展學生的知識面都非常有幫助。點膠機器人技術的開展可以培養大批相關領域的人才，進而促進相關領域的技術發展和產業化進程。但是由於國內研發此點膠機器人的單位較少，相對研發水平比較落後，研發的兩軸點膠機器人伺服控制系統的結構框圖，如圖1，長時間運行發現存在著很多安全問題，即
(1)在點膠初期，都是人工運動點膠閥到起始位置，然後僅僅依靠人眼進行初始位置的校正，使得精確度大大降低；
(2)作為點膠機器人的電源採用的是一般交流電源整流後的直流電源，當突然停電時會使整個點膠運動失敗；
(3)作為點膠機器人的執行機構採用的是步進電機，經常會遇到丟失脈衝的問題出現，導致對位置的記憶出現錯誤；
(4)由於採用步進電機，使得機體發熱比較嚴重，有的時候需要進行散熱；
(5)由於採用步進電機，使得系統運轉的機械噪聲大大增加，不利於環境保護；
(6)由於採用步進電機，其電機本體一般都是多相結構，控制電路需要採用多個功率管，使得控制電路相對比較複雜，並且增加了控制器價格；
(7)由於採用步進電機，使得系統一般不適合在高速運行；
(8)由於採用步進電機，使得系統的力矩相對較小；
(9)由於控制不當的原因，導致有的時候步進電機產生共振；
(10)相對採用的都是一些體積比較大的插件元器件，使得自動點膠機器人控制系統佔 用較大的空間，重量相對都比較重；
(11)由於受周圍環境不穩定因素幹擾，單片機控制器經常會出現異常，引起點膠機器人失控，抗幹擾能力較差；
(12)對於點膠機器人的點膠過程來說，一般要求其兩個電機的PWM控制信號要同步，由於受單片機計算能力的限制，單一單片機伺服系統很難滿足這一條件，使得點膠機器人點膠量不一致，特別是對於快速行走時；
(13)由於受單片機容量和算法影響，點膠機器人對膠點的信息沒有存儲，當遇到掉電情況時所有的信息將消失，這使得整個點膠過程要重新開始；
(14)點膠系統一旦開始，就要完成整個點膠運動，中間沒有任何暫停或緩衝的點；
(15)由於點膠機器人要頻繁的關閉和啟動，加重了單片機的工作量，單一的單片機無法滿足自動點膠機器人快速啟動和停止的要求；
(16)在所有的點膠過程中，沒有對點膠過的結果進行自動觀測和補償，有的時候使得整個曲線上膠量不一致，然後採用人工二次補膠。為了滿足高速、高效生產的需要，必須對現有的基於單片機控制的兩軸自動點膠機器人控制系統進行重新設計，尋求一種高速、高效的點膠伺服系統。

發明內容
針對上述問題，本發明的目的是提供一種兩軸全自動高速點膠機器人伺服控制系統，解決了現有技術中兩軸點膠機器人控制系統高速和高效性能差的缺陷。為解決上述技術問題，本發明採用的一個技術方案是提供一種兩軸全自動高速點膠機器人伺服控制系統，包括電池、交流電源、第一信號處理器、第二信號處理器、處理器單元、圖像採集單元、第一高速直流電機、第二高速直流電機以及點膠機器人，所述的第一信號處理器通過交流電源或者電池單獨提供電流驅動所述的處理器單元，所述的處理器單元分別發出第一控制信號和第二控制信號，所述的第一控制信號和第二控制信號分別控制所述的第二高速直流電機和第一高速直流電機，通過所述的第一高速直流電機的第二控制信號和通過所述的第二高速直流電機的第一控制信號經過第二信號處理器合成之後，控制點膠機器人的運動，所述的處理器單元還連接至圖像採集單元。在本發明一個較佳實施例中，所述的處理器單元為一雙核處理器，包括DSP處理器、FPGA處理器以及設於DSP處理器和FPGA處理器的上位機系統和運動控制系統，所述的上位機系統包括人機界面模塊、路徑讀取模塊以及在線輸出模塊，所述的運動控制系統包括伺服控制模塊、數據存儲模塊、I/o控制模塊以及圖像採集單元，其中，DSP處理器用於控制人機界面模塊、路徑讀取模塊、在線輸出模塊、數據存儲模塊、I/O控制模塊以及圖像採集單元，FPGA處理器用於控制伺服控制模塊，且DSP處理器及FPGA處理器之間實時進行數據交換和調用。在本發明一個較佳實施例中，所述的處理器單元進一步與高速直流電機的輸出端連接。在本發明一個較佳實施例中，所述的伺服控制模塊還包括轉換模塊，所述的轉換模塊用於把數位訊號轉換成模擬信號。在本發明一個較佳實施例中，所述的伺服控制模塊還包括編碼器模塊，所述的編碼器模塊用於檢測點膠機器人的實際轉速，判斷是否符合速度要求，是否過快或過慢，並發出控制信號。在本發明一個較佳實施例中，所述的伺服控制模塊還包括電流模塊，所述的電流 模塊用於調整電池的供電功率達到點膠機器人需要的範圍。在本發明一個較佳實施例中，所述的伺服控制模塊還包括速度模塊，所述的速度模塊與編碼器模塊通訊連接，當編碼器模塊檢測點膠機器人實際轉速過快或過慢，速度模塊根據編碼器模塊檢測的結果來調節點膠機器人實際轉速。在本發明一個較佳實施例中，所述的伺服控制模塊還包括位移模塊，所述的位移模塊用於檢測點膠機器人是否到達既定位移，如果離既定過遠，發出加速指令至控制器；如果離既定位移過近，則發出減速指令至控制器。本發明的兩軸全自動高速點膠機器人伺服控制系統，為了提高運算速度，保證兩軸全自動高速點膠機器人伺服控制系統的穩定性和可靠性，本發明在單片的DSP處理器中引入FPGA處理器，形成基於DSP+FPGA的雙核處理器，此處理器把原有的單片機實現的多控制器系統集中設計，並充分考慮電池在這個系統的作用，實現單一控制器同步控制兩軸的功能，把兩軸全自動高速點膠機器人伺服控制系統中工作量最大的兩軸伺服系統交給FPGA處理器控制，充分發揮FPGA處理器數據處理速度較快的特點，而人機界面模塊、路徑讀取模塊、在線輸出模塊、數據存儲模塊、I/O控制模塊以及圖像採集單元等功能交給DSP處理器控制，這樣就實現了 DSP處理器與FPGA處理器的分工，把DSP處理器從繁重的工作量中解脫出來，抗幹擾能力大大增強。


圖I為現有技術中兩軸點膠機器人伺服控制系統的原理 圖2為本發明較佳實施例的兩軸全自動高速點膠機器人伺服控制系統的原理 圖3為圖2中處理器單元的方框 圖4為點膠機器人的速度運動曲線。
具體實施例方式下面結合附圖對本發明的較佳實施例進行詳細闡述，以使本發明的優點和特徵能更易於被本領域技術人員理解，從而對本發明的保護範圍做出更為清楚明確的界定。隨著微電子技術和計算機集成晶片製造技術的不斷發展和成熟，數位訊號處理晶片(DSP)由於其快速的計算能力，不僅廣泛應用於通信與視頻信號處理，也逐漸應用在各種高級的控制系統中。TMS320F2812是美國TI公司推出的C2000平臺上的定點32位DSP處理器，適合用於工業控制，電機控制等，用途廣泛。運行時鐘也快可達150MHz，處理性能可達150MIPS，每條指令周期6. 67ns，IO 口豐富，對用戶一般的應用來說足夠了，兩個串口。具有12位的0 3. 3v的AD轉換等。具有片內128kX16位的片內FLASH，18K X 16位的SRAM，一般的應用系統可以不要外擴存儲器。加上獨立的算術邏輯單元，擁有強大的數位訊號處理能力。此外，大容量的RAM被集成到該晶片內，可以極大地簡化外圍電路設計，降低系統成本和系統複雜度，也大大提高了數據的存儲處理能力。基於現場可編程門陣列(FPGA)及現代電子設計自動化(EDA)技術的硬體實現方法是最近幾年出現了一種全新的設計思想。雖然FPGA本身只是標準的單元陣列，沒有一般的集成電路所具有的功能，但用戶可以根據自己的設計需要，通過特定的布局布線工具對其內部進行重新組合連接，在最短的時間內設計出自己的專用集成電路，這樣就減小成本、縮短開發周期。由於FPGA處理器採用軟體化的設計思想實現硬體電路的設計，這樣就使得基於FPGA處理器設計的系統具有良好的可復用和修改性，這種全新的設計思想已經逐漸應用在高性能的交流驅動控制上，並快速發展。 如圖2所示，為本發明較佳實施例的兩軸全自動高速點膠機器人伺服控制系統的原理圖。本實施例中，兩軸全自動高速點膠機器人伺服控制系統包括電池、交流電源、第一信號處理器、第二信號處理器、處理器單元、圖像採集單元、第一高速直流電機、第二高速直流電機以及點膠機器人。其中，所述電池為鋰離子電池，是一種供電裝置，為整個系統的工作提供工作電壓。 本發明中，所述的第一信號處理器通過交流電源或者電池單獨提供電流驅動所述的處理器單元，所述的處理器單元分別發出第一控制信號和第二控制信號，所述的第一控制信號和第二控制信號分別控制所述的第二高速直流電機和第一高速直流電機，通過所述的第一高速直流電機的第二控制信號和通過所述的第二高速直流電機的第一控制信號經過第二信號處理器合成之後，控制點膠機器人的運動，所述的處理器單元還連接至圖像採集單元。本發明為克服現有技術中單片機不能滿足兩軸點膠機器人行走的穩定性和快速性的要求，捨棄了國產點膠機器人所採用的單片機的工作模式，提供了 DSP+FPGA處理器的全新控制模式，控制板以FPGA處理器為處理核心，實現數位訊號的實時處理，把DSP處理器從複雜的工作當中解脫出來，實現部分的信號處理算法和響應中斷，實現數據通信和存儲實時信號。請參閱圖3，所述處理器單元為一雙核處理器，其包括DSP處理器及FPGA處理器，二者可相互通訊，實時進行數據交換和調用。所述的處理器單元還包括設於DSP處理器和FPGA處理器的上位機系統和運動控制系統，所述的上位機系統包括人機界面模塊、路徑讀取模塊以及在線輸出模塊，所述的運動控制系統包括伺服控制模塊、數據存儲模塊、I/O控制模塊以及圖像採集單元。其中，DSP處理器用於控制人機界面模塊、路徑讀取模塊、在線輸出模塊、數據存儲模塊、I/O控制模塊以及圖像採集單元，FPGA處理器用於控制伺服控制模塊。上位機系統包括人機界面模塊、路徑讀取模塊以及在線輸出模塊。人機界面模塊包括開始/重啟按鍵及功能選擇鍵；路徑讀取模塊用於讀出已經已經預設好的速度，加速度，位置等參數設置；在線輸出模塊用於提示點膠機器人的工作狀態，比如是點膠機器人工作過程中或到站狀態提示。運動控制系統包括伺服控制模塊、數據存儲模塊、I/O控制模塊以及圖像採集單元。其中，數據存儲模塊模塊為一存儲器；1/0控制模塊包括RS-232串行接口、ICE埠等；所述的圖像採集單元用於採集點膠的位置和發現故障點的情況；伺服控制模塊進一步包括轉換模塊、編碼器模塊、電流模塊、速度模塊以及位移模塊。其中，所述轉換模塊包括模擬數字轉換器(ADC, Analog to Digital Converter)及數字模擬轉換器(DAC, Digital to Analog Converter);所述編碼器模塊用於檢測點膠機器人的實際轉速，判斷是否符合速度要求，是否過快或過慢，並發出控制信號。所述電流模塊與電池和控制器、轉換模塊連接。轉換模塊根據電池和控制器的電流，判斷工作功率，並把功率狀況反饋至電池，電流模塊用於調整電池的供電功率達到點膠機器人需要的範圍。 所述速度模塊與編碼器模塊通訊連接，當編碼器模塊檢測點膠機器人實際轉速過快或過慢，速度模塊根據編碼器模塊檢測的結果來調節點膠機器人的實際轉速。所述位移模塊檢測點膠機器人是否到達既定位移，如果離既定過遠，發出加速指令至控制器；如果離既定位移過近，則發出減速指令至控制器。對於處理器單元為一雙核處理器，在電源打開狀態下，點膠機器人先進入自鎖狀態，第一高速直流電機和第二高速直流電機同時工作將執行機構(包括膠刷和出膠頭)自動移動到廢膠回收處，然後自動打開點膠閥門膠體自動流出，等均勻後自動移動執行結構到起始點，此時圖像採集單元開啟，自動校正點膠頭與起始點的對準位置，點膠機器人把儲存的實際路徑傳輸參數給控制器中的DSP處理器，DSP處理器把這些環境參數轉化為點膠機器人在指定運動軌跡下第一高速直流電機和第二高速直流電機要運行的距離，DSP處理器然後與FPGA處理器通訊，FPGA處理器再根據電機電流和光碼盤信息處理兩個獨立電機的伺服控制，並把處理數據通訊給DSP處理器，由DSP處理器繼續處理後續的運行狀態。結合以上描述，上位機系統包括人機界面模塊、路徑讀取模塊、在線輸出模塊等功能；運動控制系統包括伺服控制模塊、數據存儲模塊、I/o控制模塊以及圖像採集單元等功能。其中工作量最大的伺服控制模塊交給FPGA處理器控制，其餘的包括上位機系統交給DSP處理器控制，這樣就實現了 DSP處理器與FPGA處理器的分工，同時二者之間也可以進行通訊，實時進行數據交換和調用。本發明中兩軸全自動高速點膠機器人伺服控制系統具體的功能實現如下
O打開電源，自動傳送裝置把安裝在夾具上的加工部件自動傳送到工作區域；
2)打開電源，在打開電源瞬間DSP處理器會對電源電壓來源進行判斷，當確定是電池供電時，如果電池電壓低壓的話，將封鎖FPGA處理器的PWM波輸出，此時第一高速直流電機和第二高速直流電機不能工作，同時電壓傳感器將工作，雙核控制器會發出低壓報警信號，人機界面提示更換電池；
3)啟動點膠機器人自動控制程序，通過控制器的232串口通訊接口輸入任務或者從硬碟裝載任務；
4)第一高速直流電機和第二高速直流電機同時工作將執行機構(包括膠刷和出膠頭)移動到廢膠回收出，開始開啟閥門，然後調整膠體到均勻狀態，然後移動執行機構到起始點上方，此時圖像採集單元再次開啟，然後通過圖像採集結果使得點膠頭對準初始位置，系統開始準備點膠；
5)在出膠信號有效條件下，控制器調出點膠機器人需要行走的路徑，然後傳輸給FPGA處理器，由FPGA處理器生成點膠機器人開始工作的運動曲線，保證點膠機器人平穩工作；
6)為了能夠驅動兩軸點膠機器人運動，本控制系統引入FPGA處理器，由其生成兩軸電機運動的PWM波，但是通過I/O 口與DSP處理器進入實時通訊，由DSP處理器控制其PWM波形的輸出和封鎖；
7)在點膠機器人運動過程中，DSP處理器會時刻儲存所經過的距離或者是經過的點膠點，並根據這些距離信息確定對下一個工作點點膠機器人兩軸電第一高速直流電機和第二高速直流電機要運行的距離，DSP處理器然後與FPGA處理器通訊，傳輸這些參數給FPGA處理器，然後由FPGA處理器根據第一高速直流電機和第二高速直流電機分別的電流和光碼 盤信息生成控制電機運動的速度梯形圖，如圖4所示，這些梯形圖包含的面積就是點膠機器人第一高速直流電機和第二高速直流電機要運行的距離；
8)在運動過程中如果點膠機器人發現膠點距離求解出現死循環將向DSP處理器發出中斷請求，DSP處理器會對中斷做第一時間響應，如果DSP處理器的中斷響應沒有來得及處理，點膠機器人的第一高速直流電機和第二高速直流電機將原地自鎖；
9)裝在第一高速直流電機和第二高速直流電機上的光碼盤會輸出其位置信號A和位置信號B，光碼盤的位置信號A脈衝和B脈衝邏輯狀態每變化一次，FPGA處理器內的位置寄存器會根據第一高速直流電機和第二高速直流電機的運行方向加I或者是減I ;
10)光碼盤的位置信號A脈衝和B脈衝和Z脈衝同時為低電平時，就產生一個位置信號給FPGA處理器，記錄電機的絕對位置，然後換算成點膠機器人在點膠部件中的具體位置；
11)在運動過程中，如果控制器收到了高速點膠命令，控制器會根據點膠機器人在點膠部件的具體位置和應該存在的位置，送相應的位置數據等給FPGA處理器，FPGA處理器根據外圍傳感信號自動調取相應的PID調節模式，由FPGA處理器計算出點膠機器人的第一高速直流電機和第二高速直流電機需要更新的PWM控制信號，控制點膠機器人高速點膠；
12)在點膠過程中，如果圖像採集單元發現有任何位置的點膠出現問題，數據存儲模塊記錄下當前位置信息，然後控制器根據點膠機器人在點膠部件的具體位置，送相應的位置數據等給FPGA處理器，然後由FPGA處理器生成點膠機器人到達更新點需要的實際加速度、速度和位置信號，然後控制第一高速直流電機和第二高速直流電機進行二次點膠補償，然後再回到當初寄存下的位置，重新繼續原有的工作；
13)如果點膠機器人在運行過程中遇到突然斷電時，電池會自動開啟立即對點膠機器人進行供電，當電機的運動電流超過設定值時，此時控制器會立即封鎖FPGA處理器的PWM波輸出，第一高速直流電機和第二高速直流電機停止工作，從而有效地避免了電池大電流放電的發生；
14)為了方便點膠工作系統加入了自動暫停點，如果在點膠過程中讀到了自動暫停點，DSP處理器會通知FPGA處理器生成的PWM波可以使點膠機器人以最大的加速度停車，使加工過程出現自動暫停並存儲當前信息，直到控制器讀到再次按下「開始」按鈕信息才可以使FPGA處理器重新工作，並調取存儲信息使點膠機器人從自動暫停點可以繼續工作；15)點膠機器人在運行過程會時刻檢測電池電壓，當系統出現低壓時，傳感器會通知控制器開啟並發出報警提示，有效地保護了電池；
16)當完成整個加工部件的點膠運動後，點膠閥會停止出膠，然後控制點膠機器人走出運動軌跡；
17)點膠機器人根據新的工作部件具體位置，重新設定位置零點，等待下一周期新的工作。本發明兩軸全自動高速點膠機器人伺服控制系統具有的有益效果是
1:加入了圖形採集單元，可以幫助自動運動控制系統定位和發現故障點，自動化程度大大提聞;
2:由於採用高性能的DSP，使得系統處理速度大大增加，可以很好滿足點膠系統快速 性的要求；
3:在初期運動過程中，由自動裝置把點膠閥門推到初始位置，然後圖像採集單元開啟，幫助點膠頭對準初始位置，使得初始位置定位極其精確。4 :在運動過程中，充分考慮了電池在這個系統中的作用，基於DSP+FPGA雙核控制器時刻都在對點膠機器人的運行狀態進行監測和運算，當遇到交流電源斷電時，電池會立即提供能源，避免了自動點膠系統伺服系統運動的失敗，並且在電池提供電源的過程中，時刻對電池的電流進行觀測並保護，避免了大電流的產生，所以從根本上解決了大電流對電池的衝擊，避免了由於大電流放電而引起的電池過度老化現象的發生；
5:由FPGA處處理器處理點膠機器人的兩隻電機的獨立伺服控制，使得控制比較簡單，大大提高了運算速度，解決了現有技術中單片機運行較慢的瓶頸，縮短了開發周期短，並且系統可移植能力強；
6:基本實現全貼片元器件材料，實現了單板控制，不僅節省了控制板佔用空間，而且有利於點膠機器人體積和重量的減輕；
7:為了提高運算速度和精度，本點膠機器人採用了高速直流電機替代了傳統系統中常用的步進電機，使得運算精度大大提聞;
8:由於本控制器採用FPGA處理器處理兩軸伺服系統全部的數據與算法，把DSP處理器從繁重的工作量中解脫出來，有效地防止點膠機器人失控，抗幹擾能力大大增強；
9:由於兩路電機的控制信號是通過FPGA處理器輸出，這樣由FPGA處理器可以同時輸出PWM調製信號和方向信號，通過驅動電路可以直接驅動電機，不僅減輕了 DSP處理器的負擔，簡化了接口電路，而且省去了 DSP處理器內部編寫位置、速度控制程序，以及各種PID算法的麻煩，使得系統的調試簡單，並且實現了兩軸伺服控制的同步性；
10:在點膠機器人運行過程中，控制器會對電機的轉矩進行在線辨識並利用電機力矩與電流的關係進行補償，減少了快速行走時電機轉矩抖動對自動點膠機器人動態性能的影響；
11:在FPGA處理器內部伺服控制中，集成了多種PID調節模式，可以根據點膠機器人外圍運行情況自動調整其內部的PID參數，輕鬆實現分段P、PD、PID控制和非線性PID控制，由於沒有單片機參與此運算，使得其運動過程具有一定的自適應的功能，而且運算速度比專用運動晶片控制的系統高，有利於提高高速點膠系統的點膠速度；
12:由於具有存儲功能，這使得點膠機器人掉電後可以輕易的調取已經塗膠好的路徑信息，即使出現故障後也可以輕易的二次點膠；
13:在整個點膠過程中，如果圖像採集單元發現有任何位置或任何膠點出現點膠問題，控制器會對上述位置或點膠點進行二次補償；
14:由於採用效率更高的高速直流電機，使得系統的能源利用率更高，有利於節約能 源。以上所述僅為本發明的實施例，並非因此限制本發明的專利範圍，凡是利用本發明說明書及附圖內容所作的等效結構或等效流程變換，或直接或間接運用在其他相關的技術領域，均同理包括在本發明的專利保護範圍內。
權利要求
1.一種兩軸全自動高速點膠機器人伺服控制系統，其特徵在於，包括電池、交流電源、第一信號處理器、第二信號處理器、處理器単元、圖像採集単元、第一高速直流電機、第二高速直流電機以及點膠機器人，所述的第一信號處理器通過交流電源或者電池單獨提供電流驅動所述的處理器單元，所述的處理器單元分別發出第一控制信號和第二控制信號，所述的第一控制信號和第二控制信號分別控制所述的第二高速直流電機和第一高速直流電機，通過所述的第一高速直流電機的第二控制信號和通過所述的第二高速直流電機的第一控制信號經過第二信號處理器合成之後，控制點膠機器人的運動，所述的處理器單元還連接至圖像採集単元。
2.根據權利要求I所述的兩軸全自動高速點膠機器人伺服控制系統，其特徵在於，所述的處理器單元為一雙核處理器，包括DSP處理器、FPGA處理器以及設於DSP處理器和FPGA處理器的上位機系統和運動控制系統，所述的上位機系統包括人機界面模塊、路徑讀取模塊以及在線輸出模塊，所述的運動控制系統包括伺服控制模塊、數據存儲模塊、I/O控制模塊以及圖像採集単元，其中，DSP處理器用於控制人機界面模塊、路徑讀取模塊、在線輸出模塊、數據存儲模塊、I/O控制模塊以及圖像採集単元，FPGA處理器用於控制伺服控制模塊，且DSP處理器及FPGA處理器之間實時進行數據交換和調用。
3.根據權利要求2所述的兩軸全自動高速點膠機器人伺服控制系統，其特徵在於，所述的伺服控制模塊還包括轉換模塊，所述的轉換模塊用於把數位訊號轉換成模擬信號。
4.根據權利要求2所述的兩軸全自動高速點膠機器人伺服控制系統，其特徵在於，所述的伺服控制模塊還包括編碼器模塊，所述的編碼器模塊用於檢測點膠機器人的實際轉速，判斷是否符合速度要求，是否過快或過慢，並發出控制信號。
5.根據權利要求2所述的兩軸全自動高速點膠機器人伺服控制系統，其特徵在於，所述的伺服控制模塊還包括電流模塊，所述的電流模塊用於調整電池的供電功率達到點膠機器人需要的範圍。
6.根據權利要求4所述的兩軸全自動高速點膠機器人伺服控制系統，其特徵在於，所述的伺服控制模塊還包括速度模塊，所述的速度模塊與編碼器模塊通訊連接，當編碼器模塊檢測點膠機器人實際轉速過快或過慢，速度模塊根據編碼器模塊檢測的結果來調節點膠機器人實際轉速。
7.根據權利要求2所述的兩軸全自動高速點膠機器人伺服控制系統，其特徵在於，所述的伺服控制模塊還包括位移模塊，所述的位移模塊用於檢測點膠機器人是否到達既定位移，如果離既定過遠，發出加速指令至控制器；如果離既定位移過近，則發出減速指令至控制器。
全文摘要
本發明公開了一種兩軸全自動高速點膠機器人伺服控制系統，包括電池、交流電源、第一信號處理器、第二信號處理器、處理器單元、圖像採集單元、第一高速直流電機、第二高速直流電機以及點膠機器人，所述的第一信號處理器通過交流電源或者電池單獨提供電流驅動所述的處理器單元，所述的處理器單元分別發出第一控制信號和第二控制信號，所述的第一控制信號和第二控制信號分別控制所述的第二高速直流電機和第一高速直流電機，通過所述的第一高速直流電機的第二控制信號和通過所述的第二高速直流電機的第一控制信號經過第二信號處理器合成之後，控制點膠機器人的運動，所述的處理器單元還連接至圖像採集單元。
文檔編號G05B19/042GK102841562SQ20121036195
公開日2012年12月26日 申請日期2012年9月26日 優先權日2012年9月26日
發明者張好明, 王應海, 貢亞麗 申請人:蘇州工業園區職業技術學院