Delta機器人控制器電路優化設計*

王 磊，唐立軍

(1. 長沙理工大學 物理與電子科學學院，湖南 長沙 410114; 2. 近地空間電磁環境監測與建模湖南省普通高校重點實驗室，湖南 長沙 410114)

Delta機器人控制器電路優化設計*

王 磊1，2，唐立軍1,2

(1. 長沙理工大學 物理與電子科學學院，湖南 長沙 410114; 2. 近地空間電磁環境監測與建模湖南省普通高校重點實驗室，湖南 長沙 410114)

針對Delta機器人安全性、可靠性和可維護性方面的問題，提出了一種設計高性能Delta機器人的方法，該方法針對Delta機器人的試用情況，對控制器硬件電路工作性能、靜電放電、雷擊浪涌、射頻輻射特性等方面進行實驗研究和測試分析，進一步對Delta機器人控制器的電源電路、通信電路、信號輸入電路、外殼屏蔽和靜電釋放等關鍵電路進行了優化改進。通過優化前后的測試結果表明，優化改進后的控制器硬件電路的多項測試指標比之前有較大提升，從而進一步提高了Delta機器人的安全性、可靠性和可維護性。這種方法對于設計制作其他機器人也有較好的借鑒意義。

Delta機器人；控制器電路；Delta機器人優化設計

0 引言

1959年恩格爾伯格研制出世界上第一臺工業機器人后，生產線上自動化水平得到了較大提高[1-3]。尤其是并聯機器人因高效率、高可靠性等特點，得到廣泛使用，最具代表性的是CLAVEL R博士于1985年發明的Delta機器人，它一般具有3個空間自由度(三維空間XYZ平動)和1個轉動自由度(繞Z軸旋轉)，結構簡單、慣性小，速度快、加速度大[4-5]，常用于抓放操作[6]，具有較快運動節拍、較大工作空間以及較高的重復精度等[7-8]。

控制器作為工業機器人的四大核心零部件之一，其硬件電路的任何一部分失效或發生故障，都會對機器人的整體性能產生影響。

為更好地防范故障和排除隱患，根據Delta機器人的性能指標要求，從安全性、可靠性和可維護性出發，重點探討控制器電路的優化方案，并針對實驗室Delta機器人在生產線現場出現的實際問題，依據靜電放電、雷擊浪涌、射頻輻射等實驗結果，對實驗室Delta機器人控制器電路進行優化設計和實現，探索高性能 Delta機器人設計方法。

1 實驗室Delta機器人控制器電路的設計與實現方案

Delta機器人控制器的整體硬件電路框圖如圖1所示，電源電路負責供電，MCU最小系統處于中樞地位，負責管理和控制存儲電路、報警電路、模數轉換電路、通信電路、功率輸出電路、信號輸出電路、信號輸入電路。通過控制伺服驅動、電磁閥等執行部件，并接收信號反饋，實現Delta機器人的正常工作。

圖1 Delta機器人控制器硬件電路整體框圖

圖2 電源電路原理圖

1.1 電源電路

如圖2所示，標準+24 VDC作為電源輸入，經過流和過壓保護電路、24 V轉5 V的DC/DC開關電源電路變換為+5 VDC，再經過LDO將5 V轉為3.3 V。該電路實現了正常供電和異常保護的功能。

1.2 通信電路

TTL通信接口電路從MCU的RXD和TXD直接引出，用于編程下載、調試參數。RS485通信接口電路用于控制器之間信息交互。該電路采用MAX485芯片及外圍電阻、電容組成，為防止靜電、雷擊浪涌，設計有對于AB兩路信號的TVS保護管。該電路實現了控制器的正常通信、異常保護等功能。

1.3 信號輸入電路

如圖3所示，采用光電耦合器PS2801-4與外界輸入到控制器的信號進行隔絕，實現了保護板內電路免受外界大電流、強電壓信號的沖擊。

2 應用與測試分析

2.1 工作性能測試

2.1.1重復上下電測試

由于外部電源不穩定， Delta機器人在快速重復上電和下電過程中，容易出現不開啟、程序錯亂等安全性故障。而且在下電時，無法提前監測電壓以保存當前運行中的數據。

2.1.2重復接插測試

在實際工作應用中，容易出現過MCU的串口被燒壞、MAX485芯片被燒壞等安全性故障。于是需要重新更換MCU和MAX485芯片以完成整體硬件電路的維修工作。

另外，當光電耦合器PS2801-4由于外部強信號沖擊而損壞的時候，不僅容易干擾其余三路信號，而且維修時需要整體進行更換。

2.2 靜電放電抗擾度測試

靜電放電測試中，測試點包含了I/O口、指示燈、電源輸入端等裸露在空氣中可能受到靜電干擾的點，在每個點上，以正負極性各10次、放點間隔為5 s的放電試驗，實驗電壓由2.5 kV依次增加至6.4 kV，在試驗中觀察被試設備的工作狀態。

2.3 雷擊浪涌測試

針對控制器硬件周圍存在的雷擊浪涌干擾，設計了對于控制器硬件的雷擊浪涌實驗，目的是測試控制器硬件對于雷擊浪涌騷擾的承受能力。

圖3 信號輸入電路

2.4 射頻輻射測試

為了測量控制器硬件的輻射騷擾發射量，進行了微波暗室輻射騷擾量測量，在測試的過程中，控制部分直接暴露在測試環境中，在此種情況下會發生輻射超標問題。

2.5 近場測試

通過測試發現，MCU處在144 MHz頻率點出現尖峰，其輻射量達到了30 dBm以上，可以確定此處為144 MHz處輻射超標的輻射源頭。另外頻率小于50 MHz處的輻射量有整體升高的現象，可以確定此處為與DC-DC開關電源的頻率相關的輻射點。通過近場測試發現的144 MHz頻率點和小于50 MHz頻率范圍輻射量升高的現象，可以尋找到輻射源。

3 電路優化設計

對控制器電路在工作性能、靜電放電、雷擊浪涌、射頻輻射、近場方面的測量結果進行分析，選擇了較為關鍵的電源電路、通信電路、信號輸入電路、外殼屏蔽和靜電釋放等方面進行了優化改進，設計了一種更加優化的Delta機器人控制器電路。

3.1 電源電路優化

優化前的電源電路，雖然設計有過流保護電路和過壓保護電路，然而，在實際工作應用中仍會出現Delta機器人在快速重復上電和下電過程中機器不開啟、程序錯亂等安全性故障，以及下電時無法提前監測電壓以保存當前運行中的數據的可靠性和功能上的故障。分析發現，在機器人控制器與交流伺服電機驅動器的上下電期間，由于內部均有MCU微控制單元，兩者工作均受上電后的數字時序影響，兩者重啟時間和重啟機制也基本不一致，導致了上述故障。

交流伺服電機驅動器為工業成品，一般無法更改，優化后的電源電路中，在過流過壓保護電路和24 V轉5 V的DC/DC開關電源電路之間增加一路欠壓檢測電路，如圖4所示。當檢測到電壓低于某電壓時，欠壓信號發生翻轉，供控制器內部MCU微控制單元利用軟件進行判斷，做出相應動作，消除頻繁上下電帶來的一系列問題。

圖4 優化后的電源電路原理圖

3.2 通信電路優化

雖然在優化前設計有防止浪涌沖擊的TVS保護電路，然而在實際應用中仍出現過多次MCU串口被燒壞、MAX485芯片被燒壞等安全性故障。即便串口燒壞不影響MCU的其他性能，但也不得不重新更換MCU才能完成維修工作。由于MCU、MAX485芯片成本較高，且引腳較密，拆卸困難，這樣就給維修工作增添了很高的成本。優化后的電路，串聯了一個小阻值的貼片電阻，實現了對MCU、MAX485芯片的保護。

3.3 信號輸入電路優化

優化前的信號輸入電路中，4路集成在一起的光電耦合器比4個單獨的光電耦合器及其外圍電阻、電容等元件物料成本降低10%以上，有利于降低控制器的初始物料成本。而且由于4路集成導致的電路布局布線的面積比4個單獨的光電耦合器及其外圍元件組成的電路面積要節省30%以上。但在實際工作中發現，當光電耦合器PS2801-4由于外部強信號沖擊而損壞的時候，不僅容易干擾其余3路信號，而且維修時需要整體進行更換，由損壞導致的維護成本將遠遠超過初始物料成本，且不利于產品的安全性和可靠性，節省電路面積更沒有必要。如圖5所示，將信號輸入電路中的PS2801-4換成4路PS2701-1。優化后的電路實現了后期維護成本的降低，解決了信號間串擾問題。

圖5 優化后的信號輸入電路

3.4 外殼屏蔽和靜電釋放電路優化

優化前幾乎沒有外殼與屏蔽措施。更換成金屬外殼后將顯著提高其屏蔽效能[9-12](Shielding Effectiveness,SE)，對其電場和磁場起到雙重屏蔽效果和性能。另外，優化前的PCB固定孔處，與外殼連接的螺絲孔附近的布局布線處理只是簡單地與PCB邊緣和內部參考GND絕緣，沒有考慮靜電釋放環節。雖然能隔絕控制器電路的靜電騷擾，但不利于PCB板內部參考GND的積累電荷向大地有效釋放。于是，增加貼片式焊盤，該焊盤有兩個約0.7 mm 間距的尖端，能將板內積累電荷通過PCB固定孔傳導到金屬螺絲，然后通過金屬外殼將靜電及時釋放給大地。優化后的電路提高了控制器的抗靜電擾度、降低了射頻輻射干擾。

4 對比分析

4.1 工作性能測試

4.1.1快速重復上下電性能

優化之前，當 Delta機器人在快速重復上下電過程中，容易出現不開啟、程序錯亂等安全性故障，而且在下電時，無法提前監測電壓以保存重要數據。優化之后，由于增加一路欠壓檢測電路，不僅實現了保存重要數據的功能，而且基本消除了異常性故障，測試結果如表1所示。

表1 優化前后重復上下電異常情況對比

4.1.2重復接插性能

優化之前，出現過MCU的串口被燒壞、MAX485芯片被燒壞等安全性故障，于是需要重新更換MCU和MAX485芯片以完成整體硬件電路的維修工作。優化之后，基本沒有再出現過MCU的串口被燒壞、MAX485芯片被燒壞的現象，測試結果如表2所示。

表2 優化前后IC燒壞情況對比

優化之前，當光電耦合器PS2801-4的1路信號受沖擊損壞時，不僅干擾其余3路信號，而且維修時需整體更換。優化之后，1路損壞后在維修時也只是更換1路器件，由此增加的物料成本減少70%以上，測試結果如表3所示。

表3 優化前后所增維修物料成本對比

4.2 靜電放電抗擾度測試

優化之前，當靜電電壓超過5.5 kV時，雖未出現死機和損壞，但機器人開始出現抖動現象。優化之后，當靜電電壓超過5.8 kV時，工作正常，在6.4 kV時才出現抖動現象，測試結果如表4所示。

表4 靜電放電優化前后對比

4.3 雷擊浪涌測試

優化前后的雷擊浪涌測試情況如表5所示，當進行共模試驗時，4.2 kV時還能夠穩定工作，電壓再增加設備才出現了抖動現象，對比之前在4.2 kV時就出現抖動的現象，在性能指標上有明顯提高。

表5 雷擊浪涌優化前后對比

4.4 射頻輻射測試

優化之前，與EN55022的測試標準線對比，有多項射頻輻射指標超出標準線。在頻率為30 MHz左右時，輻射量出現了一個小高峰。在144 MHz處出現了非常明顯的幾個輻射超標的頻率點，且峰值較為集中。經過外殼和屏蔽等優化之后，在各個頻段處，輻射量都有一個整體的下降，控制器的輻射發生量有了明顯的減少，沒有輻射超標的頻點，并且個頻段的輻射發射量與標準值之間有充足的裕量。

5 結論

結合Delta機器人設計和試用中出現的問題，對其控制器硬件電路進行工作性能、靜電放電、雷擊浪涌、射頻輻射特性等方面的測試和分析，根據測試分析結果對控制器硬件電路進行優化設計，這種方法有利于提高Delta機器人的安全性、可靠性和可維護性。通過對優化前后的Delta機器人進行測試對比分析，結果表明，經過這種方法設計實現的Delta機器人有明顯的優勢。

[1] 劉振宇,郝明,趙彬,等.工業機器人在線仿真系統研究[J].微型機與應用,2014,33(6):84-86,91.

[2] 王潔. 2017年工業物聯網的機遇在哪里?[J]. 電子技術應用,2017,43(2):4-5.

[3] 恩格爾伯格. “機器人之父”致中國讀者的信[J].機器人技術與應用,1996(1): 2-3.

[4] CLAVEL R. Device for displacing and positioning an element in space[P].WO1987003528A1,1987-06-18.

[5] CLAVEL R.Device for the movement and positionning of an element in space[P].US: US4976582A,1990-12-11.

[6] 陳學生,陳在禮,孔民秀.并聯機器人研究的進展與現狀[J]. 機器人, 2002,24(5):464-470.

[7] 從爽, 尚偉偉. 并聯機器人: 建模, 控制優化與應用[M]. 北京: 電子工業出版社, 2010.

[8] MERLET J. Parallel robots[M].Springer Science & Business Media, 2006.

[9] 肖冬萍,袁軍,何為,等.高空核爆電磁脈沖對便攜式監護儀的輻射效應[J].高電壓技術, 2011,37(7): 1733-1738.

[10] 高成,劉曉,石立華,等.低頻強磁場屏蔽效能的測試方法與測試設備研制[J].高電壓技術, 2010,36(9):2272-2277.

[11] 王化吉,王永忠,張文.箱式屏蔽效能測試方法設計[J].安全與電磁兼容, 2010(2): 1-3.

[12] 曲兆明,王慶國,程二威.混響室內基于統計特性的屏蔽效能測試[J].高電壓技術, 2009,35(12): 3037-3041.

西門子擴展數字化科里奧利質量流量測量產品系列，助力過程優化

西門子Sitrans FCT030和FCT010數字轉換器現已能夠與口徑范圍為DI 1.5～DN 15的Sitrans F C MASS 2100和Sitrans FC300系列科里奧利質量流量傳感器配對使用，從而將數字化科里奧利流量計平臺的眾多過程優化優勢擴展到小流量應用領域，如液體和氣體的配料、定量給料和灌裝等。得益于該產品線的重大改進，化工和汽車行業的客戶都將受益于市場領先的0.1%質量流量精度、0.5 kg/m3密度精度和100 Hz信號處理，而啤酒灌裝等應用也得以確保最佳精度。

科里奧利流量計系列進一步擴大的產品范圍使之涵蓋了石油天然氣、船舶和化工行業中常用的大口徑應用。Sitrans FCS400系列傳感器從原來支持DN 15-DN 80口徑，擴展到DN 100和DN 150，使其應用范圍從OEM和衛生行業控制回路擴展到陸上/海上貿易交接、船舶加油和大規模化工測量等。FCS400是市面上極緊湊的一款科里奧利質量流量傳感器，它外形牢固，不受過程干擾影響，同時擁有大量適用于通用標準、衛生和NAMUR標準應用的定制過程接口。

西門子還對轉換器產品線做出了大量改進，以便實現更佳的安裝靈活性和操作簡便性。FCT030推出了墻裝式外殼支持遠傳型配置，并可選配Modbus或PROFIBUS DP/PA數字通信，這是在過程中實現數據快速交換的最佳協議。原本就擁有直觀式菜單結構和多種設置向導的全圖形人機界面(HMI)也得到了重新設計，菜單布局更加易于操作。創新的SensorFlash?microSD卡功能也更加豐富，提供了先進的數據儲存和審計跟蹤功能，每次記錄可儲存100條過程參數、診斷參數或設備設置變更信息。操作人員借此可以分析各個過程的性能并解決任何潛在的問題，從而優化工廠效率，以生產出更優質的終端產品。

(西門子公司供稿)

Circuit optimization design of Delta robot controller

Wang Lei1,2, Tang Lijun1,2

(1. School of Physics and Electronic Sciences, Changsha University of Science & Technology, Changsha 410114, China;2. Hunan Province Higher Education Key Laboratory of Modeling and Monitoring on the Near-Earth Eletromagnetic Environments, Changsha 410114, China)

For solving the problem on Delta robot’s safety, reliability and maintainability, a method to design a high performance Delta robot is proposed that is applied to the delta robot’s trial situation. The property of the controller is studied and analyzed, including performance of the hardware circuit, static discharge, lightning surge and RF radiation characteristics. It is optimized and improved for the key circuits such as power circuit, communication circuit, signal input circuit, shell shielding and electrostatic releasing of Delta robot controller. The test results show that the performance of the improved controller hardware circuit is greatly improved contrast to the past, and it is improved also about the Delta robot safety, reliability and maintainability. The method is useful for designing and creating any robots.

Delta robot; controller circuit; Delta robot optimization design

TP242.6

A

10.19358/j.issn.1674- 7720.2017.20.001

王磊，唐立軍.Delta機器人控制器電路優化設計[J].微型機與應用，2017,36(20)：1-5,9.

2017-03-30)

國家科技支撐計劃(2014BAH28F04)；湖南省教育廳科學研究項目(15K009)；湖南省研究生科研創新項目(CX2016B419)

王磊(1983-)，男，碩士，工程師，主要研究方向：信號檢測與處理。

唐立軍(1963-)，男，博士，教授，碩士生導師，主要研究方向：信號檢測與處理。