1. 概要

北京和利時電機技術(shù)有限公司自主研發(fā)的多自由度運動控制系統(tǒng)，采用全新的控制算法，創(chuàng)新的實現(xiàn)了智能再生制動、過載自動降載、掉電動態(tài)制動、電網(wǎng)電壓補償和網(wǎng)絡(luò)化通訊等關(guān)鍵技術(shù)功能，系統(tǒng)將網(wǎng)絡(luò)化伺服電機驅(qū)動器和MBOX通訊控制板卡，通過CAN總線和以太網(wǎng)總線技術(shù)的完美結(jié)合，實現(xiàn)了設(shè)備的多平臺、多自由度、高速度、高可靠的運行控制。系統(tǒng)組網(wǎng)方便靈活，可擴展性強，可廣泛用于動感平臺、運動模擬、飛行模擬、駕駛模擬、并聯(lián)機器人、舞臺、噴泉等多自由度運動平臺領(lǐng)域。

2、系統(tǒng)組成

本方案應(yīng)用于北京航空航天大學(xué)科研項目半物理仿真驗證試驗及測試，可模擬三個平動自由度和三個轉(zhuǎn)動自由度的運動。

系統(tǒng)由機械臺體、電控系統(tǒng)、主仿真機組成(見圖1)，采用數(shù)字化伺服驅(qū)動和網(wǎng)絡(luò)化等系統(tǒng)技術(shù)，實現(xiàn)機械臺體的偏航、俯仰、滾轉(zhuǎn)、縱向、橫向、垂向六自由度精確控制。

2.1 電控系統(tǒng)組成

多自由度運動平臺電控系統(tǒng)由網(wǎng)絡(luò)化伺服電機驅(qū)動器和MBOX通訊控制板卡組成，運用CAN總線和以太網(wǎng)總線技術(shù)，實現(xiàn)設(shè)備的多平臺、多自由度、高速度、大容量的運行控制。

圖2是網(wǎng)絡(luò)化伺服驅(qū)動系統(tǒng)通過CAN總線和MBOX通訊控制器構(gòu)成網(wǎng)絡(luò)化伺服控制系統(tǒng)的典型構(gòu)架。MBOX與上位計算機之間通過交換機實現(xiàn)以太網(wǎng)的通訊，MBOX與伺服驅(qū)動器之間實現(xiàn)CAN總線的通訊。MBOX還可以與本地計算機或觸摸屏實現(xiàn)基于通過RS232等接口的MODBUS通訊，便于監(jiān)控和調(diào)試。同時, MBOX還提供8路數(shù)字輸入，12路數(shù)字輸出及2路模擬量輸出接口，便于通過以太網(wǎng)總線實現(xiàn)低成本的數(shù)字及模擬接口數(shù)據(jù)采集和控制。

2.2 電控系統(tǒng)功能特點

（1）網(wǎng)絡(luò)化伺服驅(qū)動系統(tǒng)

  網(wǎng)絡(luò)化伺服驅(qū)動系統(tǒng)采用TI最新的32位含浮點運算能力的雙核數(shù)字信號處理芯片，采用全新的伺服控制算法，對永磁同步伺服電機的位置、速度、加速度和輸出轉(zhuǎn)矩進行精確控制。

  1、通用運動控制功能: 位置/速度/力拒控制, 模式切換；

  2、快速的電流環(huán)浮點CLA內(nèi)核處理，具有良好的動態(tài)跟隨性；

  3、內(nèi)置電網(wǎng)電壓補償控制，自動適應(yīng)電網(wǎng)電壓的波動；

  4、內(nèi)置2路可選共振低通濾波，以及2級共振陷波濾波器，有效應(yīng)對機械共振；

  5、 內(nèi)置專有智能再生制動控制技術(shù)；

  6、內(nèi)置轉(zhuǎn)矩觀測器技術(shù)，自動適應(yīng)負載的變化；

  7、控制增益可切換或內(nèi)部自適應(yīng)匹配；

  8、內(nèi)置動態(tài)制動控制，為驅(qū)動提供額外的安全防護；

  9、具有過載自動降載算法，可參數(shù)化選擇是否過載保護，以及參數(shù)化設(shè)置自動平滑降載及恢復(fù)過載能力；

  10、支持MODBUS協(xié)議的 RS232及RS485通訊接口，直接與上位機和觸摸屏等通訊；

  11、支持CAN總線接口，內(nèi)置專有通訊協(xié)議，方便客戶定制使用；

  12、控制端口支持軟件方式分配、邏輯設(shè)置、可編程濾波，使用靈活方便可靠；

  13、脈沖模擬量接口, 脈沖輸入頻率最高可達1MHZ；

  14、2路模擬量輸出可觀測驅(qū)動器內(nèi)部狀態(tài)，方便現(xiàn)場調(diào)試；

  15、內(nèi)置功率器件溫度監(jiān)控和過流，過壓以及過熱等保護，確?？煽框?qū)動；

  16、具有歷史故障記錄等可靠性管理功能。 

（2）MBOX通訊控制器

   MBOX是一款專為伺服網(wǎng)絡(luò)化控制應(yīng)用開發(fā)的一款以太網(wǎng)到CAN總線的雙向數(shù)據(jù)傳遞的，含有RS232或RS422，12路數(shù)字輸出，2路模擬輸出，8路數(shù)字輸入等信號接口的多功能應(yīng)用板卡。其中的CAN總線采用了電氣隔離技術(shù)，確保總線驅(qū)動的可靠與安全。 

（3）HS伺服驅(qū)動系統(tǒng)與MBOX通訊控制板卡構(gòu)成的網(wǎng)絡(luò)化控制系統(tǒng)

網(wǎng)絡(luò)化伺服驅(qū)動系統(tǒng)，提供了3種總線接口，包括RS232，RS485以及CAN總線。其中RS232接口是標準配置的通訊接口，RS485和CAN總線是選配的通訊接口，采用了電氣隔離及瞬態(tài)電壓抑制保護技術(shù)，具有良好的電磁兼容性和可靠性。

標準配置的RS232接口實現(xiàn)網(wǎng)絡(luò)化伺服驅(qū)動系統(tǒng)與上位機或觸摸屏的點到點通訊，可實現(xiàn)對伺服驅(qū)動系統(tǒng)的狀態(tài)監(jiān)視、參數(shù)讀寫以及總線模式的控制，當用戶要求網(wǎng)絡(luò)化伺服驅(qū)動系統(tǒng)組網(wǎng)運行時，可選擇RS485總線或CAN總線。

  網(wǎng)絡(luò)化伺服驅(qū)動系統(tǒng)加強了總線模式下的控制功能，支持RS232，RS485以及CAN總線接口的多種總線模式控制，包括：

1、總線接口的轉(zhuǎn)矩模式控制

2、線接口的轉(zhuǎn)速模式控制

3、總線接口的相對位置模式控制

4、總線接口的絕對位置模式控制

3、北航六自由度平臺設(shè)計方案

   全電動多自由度運動平臺技術(shù)方案：采用電動缸和交流伺服電機及驅(qū)動器控制方案，具有響應(yīng)速度快，控制精度高，使用方便，操作便捷等優(yōu)點。我們從底層內(nèi)核為該平臺的電動缸控制實現(xiàn)優(yōu)化，其控制響應(yīng)性能及環(huán)保等要素遠遠超過液壓控制方案。

   全網(wǎng)絡(luò)化拓撲通訊控制：通過和利時電機公司自主研發(fā)的網(wǎng)絡(luò)化運動控制器MBOX實現(xiàn)以太網(wǎng)+CAN總線兩級拓撲，通訊容量大，速度快，可擴展性好，絕對位置信號帶CRC校驗，可靠性高，兼顧性能和成本，遠優(yōu)于單一的以太網(wǎng)或 CAN 總線網(wǎng)絡(luò)拓撲。

   雙向遠程監(jiān)控：上位機通過以太網(wǎng)連接MBOX運動控制器，MBOX運動控制器與HS 伺服驅(qū)動器進行了高度緊密的系統(tǒng)集成。上位機即可以控制 MBOX 的運行參數(shù)及每個自由度的伺服運行位置，還可以實時監(jiān)控每個自由度的運行速度，實際位置，負載率，伺服狀態(tài)字等信息。

   過載自動降載及恢復(fù)技術(shù)：伺服驅(qū)動器具有智能過載自動降載及恢復(fù)技術(shù)，免除電動缸及電機的短時過載的保護導(dǎo)致的停機及故障麻煩。

   可靠性管理技術(shù)：系統(tǒng)可以統(tǒng)計電動缸及電機的使用時間及使用壽命時間，方便進行運動平臺的可靠性維護。

   提供多種緊急停機處理：可以通過上位機用以太網(wǎng)通訊或本地數(shù)字輸入開關(guān)的方式，實現(xiàn)動感平臺的緊急停機。可以緊急停止在當前位置，當前 X,Y,Z 軸任意一軸水平或平均位置，或緊急停止在起始位置。

   智能再生制動控制：用于運動平臺快速回落過程中的伺服驅(qū)動器的再生能量回饋及其處理。

   電網(wǎng)電壓自動補償: HS伺服驅(qū)動器具備電網(wǎng)電壓補償算法功能，自動應(yīng)對電網(wǎng)電壓的波動。 

   支持電磁制動和動態(tài)制動功能：HS伺服驅(qū)動器針對電源斷電及故障發(fā)生情況下，支持電磁制動（抱閘）和動態(tài)制動功能，確保平臺的安全停機。

   人性化PC人機界面: 基于LabWindows編程環(huán)境的圖形化上位機軟件人機操作界面，支持點動控制，正弦控制，姿態(tài)控制等六自由度平臺的常用各種操作，可隨時按用戶需求升級或完善上位機軟件。

  支持完全無限位傳感器初始定位技術(shù)：利用和利時電機公司自主知識產(chǎn)權(quán)的HS系列伺服驅(qū)動器，可以從驅(qū)動內(nèi)核來實現(xiàn)電動缸完全無限位傳感器的初始定位技術(shù)，從而降低系統(tǒng)成本和故障率。

  輔助調(diào)試 HMI 界面：通過MBOX用RS232接口實時監(jiān)控每個自由度的運行速度，實際位置，負載率，伺服狀態(tài)字等信息，便于調(diào)試以及診斷等。