實現(xiàn)水下波動仿生推進器的多電機獨立控制設(shè)計方案

引言

作為一種面向水下航行器的新型仿生推進裝置，波動仿生推進器主要模擬依靠身體波動式推進的魚類的游動方式，以單柔性長鰭的波動推進為基礎(chǔ)，利用多背鰭之間的協(xié)同控制來產(chǎn)生推力、升力、偏航和俯仰力矩。在機構(gòu)設(shè)計上，一個單柔性長鰭由若干根鰭條組成，通過對這若干根鰭條進行不同的配置，可以實現(xiàn)單柔性長鰭不同的波形。而波形參數(shù)（波長、波幅、波頻、波傳播方向等）的不同將直接影響到單柔性長鰭所產(chǎn)生推力的大小。在研究初期，需要對單柔性長鰭進行靈活控制，以便確定推進效率最優(yōu)的波形參數(shù)。為此，我們設(shè)計了一種多電機獨立控制方案，即由一個電機控制一根鰭條，通過電機之間的協(xié)調(diào)來實現(xiàn)對單柔性長鰭的波動控制。

CAN（Controller Area Network）總線，又稱控制器局域網(wǎng)，是Bosch公司在現(xiàn)代汽車技術(shù)中領(lǐng)先推出的一種多主機局部網(wǎng)，也是一種串行通訊協(xié)議。其卓越的可靠性和傳輸?shù)母咚傩?，使它能夠有效地支持具有很高安全等級的分布式實時控制。CAN總線現(xiàn)在已廣泛應(yīng)用于工業(yè)現(xiàn)場控制、智能大廈、環(huán)境監(jiān)控等眾多領(lǐng)域，從高速的網(wǎng)絡(luò)到通用的多路接線都可以使用。在汽車電子行業(yè)里，使用CAN總線連接發(fā)動機控制單元、傳感器、防剎車系統(tǒng)等，其傳輸速度可達1Mbit/s。波動仿生推進器多電機系統(tǒng)內(nèi)部通訊總線與汽車內(nèi)部總線有很多相似的特性，如都處于強機械震蕩、強電磁干擾環(huán)境等，而且CAN總線在機器人內(nèi)部通訊系統(tǒng)中的應(yīng)用已經(jīng)有了許多成功的先例。因此在波動仿生推進器的內(nèi)部通訊總線設(shè)計中采用CAN 協(xié)議。

1 、系統(tǒng)總體結(jié)構(gòu)

水下波動仿生推進器采用分級控制的思路，總體網(wǎng)絡(luò)結(jié)構(gòu)如圖1所示。在岸上，以一臺IBM-PC機作為操控平臺，實現(xiàn)操縱命令的給定、彈載內(nèi)部運行狀態(tài)的監(jiān)測與可視化管理以及人機界面的功能。它通過RS-232總線連接到仿生推進器內(nèi)部的主控上位機PC/104上。PC/104是仿生推進器運動控制的核心模塊，負責實現(xiàn)除底層電機控制模塊以外的所有上層控制算法，包括多電機的波形控制、姿態(tài)與深度測量、安全狀態(tài)監(jiān)控等。其中，多電機的波形控制是通過PC/104對底層若干個電機控制節(jié)點的協(xié)調(diào)來實現(xiàn)的，通過采用基于CAN現(xiàn)場總線的串行通信協(xié)議，保證了通信的可靠性及實時性。

在本系統(tǒng)中，核心控制部分采用SBS公司的PC/104模塊，并通過該公司集成的基于PC/104的CSD-CAN總線控制器與波動仿生推進器內(nèi)部的各控制節(jié)點組成CAN通信網(wǎng)絡(luò)。在底層各電機控制節(jié)點上，采用日本安川公司模塊化SGMAH04型交流伺服電機和相應(yīng)SGDM04ADA型伺服驅(qū)動器。該伺服驅(qū)動器可通過自帶的RS-232串口（CN3）與數(shù)字操作器或者PC聯(lián)接，通過編碼器接頭（CN2）聯(lián)接編碼器至伺服電機，同時它還提供一個實時I/O端口（CN1）可與運動模塊MP910等或其它上級裝置聯(lián)接。向其I/O端口發(fā)送脈沖序列可以對電機進行速度和位置控制，向其串口發(fā)送命令指令可以獲取電機當前的速度和位置信息。這樣，我們可以跳過最底層與電機接口部分的軟硬件開發(fā)，而通過單片機直接對伺服驅(qū)動器進行控制。在各個電機控制節(jié)點上，研制相應(yīng)的CAN智能節(jié)點以實現(xiàn)與彈載上位機PC/104的通信。

波動仿生推進器中CAN網(wǎng)絡(luò)必須具備波形控制和狀態(tài)監(jiān)控兩大功能。對于該多電機系統(tǒng)，各個節(jié)點相互獨立，通過在PC/104中對這若干個節(jié)點進行合理的調(diào)配來實現(xiàn)波動仿生推進器的波形控制功能。另外，各CAN節(jié)點實時監(jiān)測本控制節(jié)點對應(yīng)電機的工作狀態(tài)，并將其返回給上位機;同時，各CAN節(jié)點定時監(jiān)測節(jié)點本身的工作狀態(tài)，利用CAN總線協(xié)議強大的錯誤處理功能對各種可能出現(xiàn)的錯誤進行分析處理。

2、 CAN網(wǎng)絡(luò)的硬件方案

由圖1可知，各個CAN節(jié)點直接掛接于同一個CAN網(wǎng)絡(luò)。它們的軟硬件組成結(jié)構(gòu)完全一致，硬件組成框圖見圖2。

系統(tǒng)中的各CAN節(jié)點采用的都是智能節(jié)點，即都由微控制器和可編程的CAN控制芯片組成。從圖2可以看出，各CAN節(jié)點電路主要由微控制器AT89C51、獨立CAN控制器SJA1000、CAN收發(fā)器82C250、高速光耦6N137、撥碼開關(guān)地址輸入電路、電源監(jiān)測與看門狗電路以及面向伺服電機的部分電路組成。

由于采用了模塊化的伺服電機驅(qū)動器，各控制節(jié)點只需實現(xiàn)簡單的伺服控制功能，故采用Atmel公司的8位單片機AT89C51作為微控制器。CAN控制芯片完成CAN的通信協(xié)議，主要由實現(xiàn)CAN總線協(xié)議的部分與實現(xiàn)與微控制器接口部分的電路組成，這里采用的是PHILIPS公司的SJA1000。它是一種獨立CAN控制器，具有BasicCAN和PeliCAN兩種工作模式，其中PeliCAN模式支持具有很多新特性的CAN2.0B協(xié)議。82C250是高性能的CAN總線收發(fā)器，是CAN協(xié)議控制器和物理總線的接口，它對總線提供差動發(fā)送能力，對CAN控制器提供差動接收能力。通過對82C250的8號管腳的不同設(shè)置，可使其工作于高速、待機、斜率等三種模式。

撥碼開關(guān)地址輸入電路用于對各個CAN節(jié)點的標識。上電后，單片機首先讀取撥碼開關(guān)的數(shù)值，并在CAN初始化中將其寫入SJA1000的接收代碼寄存器，作為該節(jié)點的標識碼。電源監(jiān)測與看門狗電路采用的是MAX813，它在系統(tǒng)上電時刻提供上電復(fù)位功能，在程序運行時提供看門狗監(jiān)測和電源監(jiān)測功能，并能夠?qū)崿F(xiàn)手動復(fù)位。

為進一步提高CAN總線的可靠性，在系統(tǒng)設(shè)計中采取了一系列的抗干擾措施。一方面將SJA1000與82C250通過高速光耦6N137相連，從而實現(xiàn)了CAN總線上各CAN節(jié)點的電氣隔離。另一方面，在82C250與CAN物理總線的接口部分也采用一定的安全和抗干擾措施。比如，82C250 的CANH和CANL引腳各自通過一個5Ω的電阻與CAN總線相連，可起到一定的限流作用，保護82C250免受過流的沖擊;CANH和CANL與地之間分別并聯(lián)一個30P的小電容，可以起到濾除總線上的高頻干擾和一定的防電磁輻射的能力;CANH和CANL與地之間分別反接了一個保護二極管，這樣，當CAN總線有較高的負電壓時，通過二極管的短路可起到一定的過壓保護作用。

另外，為了保護各CAN節(jié)點控制端不受電機端的影響，在單片機與電機接口處均采用了基于6N137的光電隔離方案。這樣，當伺服電機端有大電壓電流產(chǎn)生時，由于光耦的保護作用，不會對控制端產(chǎn)生較大影響。

在應(yīng)用光電隔離方案時要注意的一個重要問題是要必須確保光耦兩端的兩個電源完全隔離，否則光電隔離將起不到其應(yīng)有的保護作用。在本系統(tǒng)中，通過采用廣州金升陽公司的小功率電源隔離模塊B0505S-1W很好地實現(xiàn)了各電源之間的完全隔離。

3、 CAN網(wǎng)絡(luò)的軟件設(shè)計

CAN網(wǎng)絡(luò)的軟件主要包括三部分：初始化設(shè)計、通信設(shè)計、電機協(xié)調(diào)控制設(shè)計。下面從CAN控制節(jié)點的角度對它們進行說明。

3.1 初始化設(shè)計

CAN網(wǎng)絡(luò)的初始化包括對微控制器內(nèi)部資源的初始化和CAN控制器SJA1000的初始化。微控制器的內(nèi)部資源包括程序中使用的各控制變量、定時器、外部中斷、串口等，需要在程序進入正常工作前對它們進行合理的設(shè)置。這里重點對SJA1000的初始化進行說明。

SJA1000的初始化只能在復(fù)位模式下進行。其主要內(nèi)容包括工作方式的設(shè)置、接收濾波方式的設(shè)置、接收屏蔽寄存器和接收代碼寄存器的設(shè)置、波特率參數(shù)的設(shè)置、中斷允許寄存器的設(shè)置等等。在完成SJA1000的初始化設(shè)置之后，應(yīng)使SJA1000回到工作模式，進行正常的通信任務(wù)。圖3是SJA1000的初始化流程圖。需要特別引起注意的是，在同一個CAN網(wǎng)絡(luò)中，各個CAN節(jié)點必須設(shè)置成相同的波特率，否則無法進行CAN通信。

3.2 通信設(shè)計

CAN網(wǎng)絡(luò)能否正常工作很大程度上取決于基于CAN總線的發(fā)送和接收程序能否正確設(shè)計。跟大多數(shù)的通信過程一樣，CAN的發(fā)送和接收也分為查詢和中斷兩種方式。在本系統(tǒng)中，發(fā)送采用查詢方式，接收采用中斷方式。發(fā)送時用戶只需將待發(fā)送的數(shù)據(jù)按特定格式組合成一幀報文，送入SJA1000的發(fā)送緩存區(qū)中，然后啟動SJA1000發(fā)送即可。其間需要對CAN總線的發(fā)送緩存區(qū)狀態(tài)進行判斷。發(fā)送流程如圖4。

在PeliCAN模式中，SJA1000有8個不同的中斷，接收中斷是其中的一個。一旦CAN產(chǎn)生中斷，SJA1000就將中斷輸出設(shè)為低電平，直到主控制器通過讀SJA1000的中斷寄存器對中斷采取相應(yīng)措施，或釋放接收緩存器后產(chǎn)生接收中斷。在主控制器完成該動作后，SJA1000將輸出中斷跳到高電平。處理中斷請求的握手信號或兩個中斷之間的高電平脈沖要求主控制器的中斷由電平觸發(fā)。中斷接收的流程如圖5所示。相比發(fā)送子程序而言，它除了進行單純的數(shù)據(jù)幀接收之外，還要對中斷運行寄存器中允許引起中斷的各種錯誤（比如總線脫落、錯誤報警、接收溢出等）進行判斷并作相應(yīng)處理。在波動仿生推進器的應(yīng)用里，設(shè)置了接收中斷和數(shù)據(jù)溢出中斷，并在主程序里定時檢測總線狀態(tài)，如果發(fā)現(xiàn)總線脫離，則對SJA1000進行復(fù)位處理。

3.3 電機協(xié)調(diào)控制設(shè)計

波動仿生推進器單柔性長鰭的波動控制要求其多電機系統(tǒng)按照設(shè)定的波動參數(shù)帶動多個鰭條形成相應(yīng)的波形。由于采用了高性能的伺服電機及驅(qū)動器，我們可以很精確的控制電機的運行速度，故在形成了各電機之間按設(shè)定波長要求的相位差之后，只要保持各個電機之間速度的嚴格同步，就可以實現(xiàn)多個電機之間的協(xié)調(diào)運轉(zhuǎn)。為此，需要在各個電機控制節(jié)點里預(yù)先設(shè)置一些相關(guān)的控制原語，如電機原點定位、相位調(diào)整、速度設(shè)定、方向設(shè)定以及停機等基本電機控制指令。主控模塊PC/104通過對這些控制原語的合理調(diào)用，便可實現(xiàn)各種類型的波形。

另一種更合理可靠的方法是，各電機控制節(jié)點采集伺服電機上增量編碼器的角度脈沖信號，經(jīng)過解析將角度數(shù)字信號送往PC/104。在每個控制周期內(nèi)，PC/104對這些角度信號進行綜合處理，通過一定的協(xié)調(diào)機制來實時修改對電機的控制量。由于CAN總線在一定條件下其最高通信速率可達1Mbps，通過設(shè)定適當?shù)目刂浦芷冢梢詽M足本系統(tǒng)的需要。

4、 結(jié)論

本文設(shè)計的CAN總線系統(tǒng)在波動仿生推進器的波動控制中得到了成功應(yīng)用。與基于RS-232總線的控制系統(tǒng)相比，本系統(tǒng)在通信的可靠性和快速性上體現(xiàn)出了較大優(yōu)勢。在通信速率為250Kbps以及13個底層節(jié)點的情況下，通過實際反復(fù)的靜水和航行試驗表明其通信效果完全可以滿足系統(tǒng)的需要，同時該CAN總線系統(tǒng)也具備良好的波形控制和狀態(tài)監(jiān)測功能。

本文作者創(chuàng)新點：基于CAN總線技術(shù)設(shè)計了新型的波動仿生推進器控制系統(tǒng)，給出了詳細的軟硬件設(shè)計方案，并對多個電機的協(xié)調(diào)控制作了相應(yīng)分析。