基于MSP430單片機的伺服電機控制系統(tǒng)的研究

李彩菊（中國船舶重工集團公司第七一〇研究所，湖北宜昌　443003）

?

基于MSP430單片機的伺服電機控制系統(tǒng)的研究

李彩菊
（中國船舶重工集團公司第七一〇研究所，湖北宜昌443003）

摘要：介紹了一種基于MSP430單片機控制交流伺服電機的方案設計。該設計以MSP430單片機作為核心控制器，包括硬件設計和軟件設計，能夠?qū)崿F(xiàn)對交流伺服電機轉(zhuǎn)速的平穩(wěn)控制。該設計在深度模擬系統(tǒng)中取得了成功應用，通過電機轉(zhuǎn)動帶動加壓機構(gòu)可在高壓釜內(nèi)模擬限定值內(nèi)的任意深度環(huán)境。

關鍵詞：MSP430單片機；交流伺服電機；轉(zhuǎn)速控制；深度模擬系統(tǒng)

0　引言

交流伺服電機具有體積小、重量輕、精度高、大轉(zhuǎn)矩輸出、較強的過載能力[1]和良好的控制性等優(yōu)點，已被廣泛應用于自動控制系統(tǒng)和自動檢測系統(tǒng)中[2]。交流伺服電機的作用是把控制電壓轉(zhuǎn)變?yōu)殡妱訖C軸上的角速度或角位移輸出，因此可采用單片機及其配套外圍模塊實現(xiàn)對伺服電機的模擬量控制。

本設計采用美國德克薩斯儀器公司的超低功耗16位單片機MSP430F1611作為控制核心，利用其豐富的片內(nèi)資源，實現(xiàn)了對交流伺服電機轉(zhuǎn)速的平穩(wěn)控制及人性化設計，且成本較低。將該設計應用于深度模擬系統(tǒng)中，通過單片機控制伺服電機驅(qū)動器，電機帶動加壓機構(gòu)，實現(xiàn)了在高壓釜內(nèi)模擬限定值內(nèi)的任意深度環(huán)境。將被試品安裝于盛滿水的密閉高壓釜內(nèi)，通過上位機發(fā)送加壓指令，單片機控制伺服電機驅(qū)動器，使高壓釜內(nèi)達到設定壓力，這樣即將被試品周圍模擬成了一定深度（壓力）的水壓環(huán)境。

1　總體方案設計

設計選用松下A5系列高慣量、小容量三相交流伺服電機，及配套速度控制驅(qū)動器，所選旋轉(zhuǎn)式編碼器為20位增量式編碼器，通過單片機控制器輸出模擬電壓控制驅(qū)動器實現(xiàn)對伺服電機轉(zhuǎn)速的控制。

上位機用于給單片機發(fā)送控制指令并實時顯示單片機反饋信息。在深度模擬系統(tǒng)中，上位機給單片機發(fā)送加壓、泄壓、停止及參數(shù)設置等一系列控制指令，并實時顯示高壓釜內(nèi)壓力值。單片機控制器接收上位機控制指令和操作面板活塞復位指令，進行分析結(jié)算，輸出模擬電壓值；伺服電機驅(qū)動器根據(jù)電壓信號控制伺服電機運轉(zhuǎn)；驅(qū)動器接收編碼器產(chǎn)生的反饋信號，根據(jù)反饋值與目標值比較結(jié)果，調(diào)整電機轉(zhuǎn)動的角速度，從而實現(xiàn)對交流伺服電機的閉環(huán)控制。操作面板的作用是對整個系統(tǒng)進行電源控制，并控制電機使能、活塞復位和清除報警。保證系統(tǒng)能在緊急情況下迅速制動，確保了使用安全。交流伺服電機控制系統(tǒng)組成框圖如圖1所示。

圖1　控制系統(tǒng)組成框圖

圖1中，加入虛線框內(nèi)的加壓機構(gòu)、高壓釜和壓力傳感器即構(gòu)成深度模擬系統(tǒng)。壓力傳感器監(jiān)測壓力釜內(nèi)的壓力，MSP430單片機控制器定時讀取壓力傳感器，通過PID算法解算，輸出模擬電壓值，繼續(xù)控制伺服電機驅(qū)動器，通過電機轉(zhuǎn)動帶動加壓機構(gòu)使高壓釜內(nèi)壓力變化；并將高壓釜內(nèi)的壓力轉(zhuǎn)換為深度實時傳送給上位機顯示；如此循環(huán)反饋，直到壓力釜內(nèi)的壓力達到上位機設定值，則完成加壓過程。加壓的時間可通過調(diào)節(jié)伺服電機驅(qū)動器參數(shù)完成。泄壓過程與加壓過程類似，通過控制電機正反轉(zhuǎn)完成，從而實現(xiàn)了在高壓釜內(nèi)模擬限定值內(nèi)的任意深度環(huán)境。

2　系統(tǒng)硬件設計

2.1單片機控制器的硬件設計

單片機控制器是基于單片機MSP430F1611而設計的，是本系統(tǒng)的核心部分，其主要功能是：接收上位機發(fā)送的控制指令和操作面板指令，解析指令，對伺服電機的轉(zhuǎn)速進行控制。在深度模擬系統(tǒng)中，單片機控制器的主要功能有三：一是與上位機進行RS232串口通信，接收指令并反饋當前壓力釜內(nèi)的壓力值；二是與壓力傳感器進行RS485串口通信，讀取壓力傳感器壓力值；三是通過PID算法，計算控制電壓，并控制DA芯片將單片機計算的模擬電壓轉(zhuǎn)換為電機驅(qū)動器所需模擬電壓。所用單片機功能有串口通信、定時中斷、輸入/輸出等。單片機控制器電路如圖2所示。

圖2　單片機控制器電路

本設計所選單片機MSP430F1611具有兩個串口通信模塊USART0和USART1，該模塊既可以作為UART使用，提供異步通信功能，也可以作為SPI使用，提供同步通信功能。在深度模擬系統(tǒng)中，單片機控制器利用兩個串口通信模塊的異步通信功能，一個通過芯片MAX3232與上位機進行RS232串口通信；另一個通過芯片MAX3078與壓力傳感器進行RS485串口通信，讀取壓力傳感器壓力值。操作面板復位指令為+24 V電平，通過電平轉(zhuǎn)換芯片TLP521轉(zhuǎn)換成單片機所需的+3.3 V電平，該電平轉(zhuǎn)換芯片TLP521為東芝光隔芯片，不僅可以進行電平轉(zhuǎn)換，還對輸入、輸出信號具有隔離作用。

單片機MSP430F1611具有12位DA轉(zhuǎn)換模塊DAC12，為提高轉(zhuǎn)換精度，本設計選擇專用DA轉(zhuǎn)換芯片MAX5442，該芯片具有16位轉(zhuǎn)換精度，且轉(zhuǎn)換速度較快[3]。單片機通過I/O引腳P2.7、P3.1 和P3.3進行控制，既可以通過配置串口通信模塊USART0進行SPI同步通信，也可以通過模擬I/O的方式進行控制。在深度模擬系統(tǒng)中，因兩個串口通信模塊都已經(jīng)被利用，因此采用模擬I/O的方式對芯片MAX5442進行控制。單片機I/O口輸出0～3.3 V數(shù)字電壓信號，通過DA轉(zhuǎn)換電路和低通濾波器輸出-5 V～+5 V模擬電壓信號，提供給電機驅(qū)動器。DA控制電路如圖3所示。

圖3　DA控制電路

圖3中，網(wǎng)絡標號DACS、SPIUCLK0和SPISI?MO0為單片機提供的控制信號，VREF為2.5 V參考電壓。單片機I/O口輸出數(shù)字電壓經(jīng)DA芯片MAX5442，再經(jīng)運算放大芯片輸出-2.5 V～+2.5 V模擬電壓信號，最后經(jīng)過增益為2的低通濾波器則可輸出-5 V～+5 V模擬電壓信號。

2.2伺服電機驅(qū)動器接口設計

伺服電機驅(qū)動器的接口設計主要包括連接器XA、XB、X6和X4的連接。其中XA為主電源和控制電源輸入接口；XB為電機接口，為電機輸出三相電源；X6為編碼器接口；X4為信號接口，其接線原理圖如圖4所示。

圖4　電機驅(qū)動器X4連接器接線原理圖

圖4中，網(wǎng)絡標號CTRLSignal為單片機控制器輸出的電機速度控制信號；VSignal為電機驅(qū)動器反饋的速度信號，單片機控制器接收并采集，作為備用；On_Off_State為行程開關狀態(tài)信號，電路設計的該初始狀態(tài)為低電平，接電機驅(qū)動器反向驅(qū)動禁止輸入端CWL，電機驅(qū)動器正向驅(qū)動禁止輸入端CCWL也接低電平，則電機可正向轉(zhuǎn)動也可以反向轉(zhuǎn)動。在深度模擬系統(tǒng)中，電機反向轉(zhuǎn)動帶動加壓機構(gòu)減壓，如果碰到行程開關，則行程開關狀態(tài)信號On_Off_State變?yōu)楦唠娖?，電機立刻停止反向轉(zhuǎn)動。當電機驅(qū)動器報警時，信號ALARM會傳到操作面板通過紅色指示燈形象顯示，同時傳給單片機控制器，單片機控制器反饋給上位機，清除報警后，按操作面板的報警清除按鈕，電機驅(qū)動器會停止報警。

伺服電機驅(qū)動器有一系列的參數(shù)，通過對這些參數(shù)的設置和調(diào)整，用戶可以改變伺服系統(tǒng)的功能和特性。為了確保系統(tǒng)按照既定的方式運行，需要先對電機驅(qū)動器恢復出廠設置，然后對其相關參數(shù)進行設置。

2.3操作面板設計

操作面板的作用是保證系統(tǒng)能在緊急情況下迅速制動，確保使用安全，并對系統(tǒng)的運行狀態(tài)進行簡單指示。在深度模擬系統(tǒng)中，操作面板設計有電源控制、電機使能、活塞復位和清除報警按鈕，還有24 V電源和電機報警指示燈。其中，電源控制和電機使能為帶燈并具有自鎖功能的按鈕，活塞復位和報警清除為不帶燈并沒有自鎖功能的按鈕。在每次使用深度模擬系統(tǒng)前，需先進行活塞復位，保證系統(tǒng)回到初始狀態(tài)。操作面板布局圖如圖5所示。

圖5　操作面板布局圖

3　系統(tǒng)軟件設計

系統(tǒng)軟件設計主要為單片機控制軟件設計。單片機控制軟件主要完成串口通信、定時、FLASH讀寫及PID算法等功能。

當今控制理論和技術(shù)高速發(fā)展的時代，PID控制算法因結(jié)構(gòu)簡單、控制參數(shù)容易整定、魯棒性強及容易實現(xiàn)等優(yōu)點，工業(yè)生產(chǎn)中95%以上的控制回路都采用PID控制算法。本系統(tǒng)采用改進的PID算法，當誤差大時，加大誤差控制作用的權(quán)重，以快速消除誤差，提高系統(tǒng)響應速度；當誤差小時，減小誤差控制作用的權(quán)重，以避免超調(diào)，能使系統(tǒng)盡快進入穩(wěn)定狀態(tài)[4]。

在深度模擬系統(tǒng)中，單片機控制軟件設計定時周期50 ms，每個定時周期接收上位機指令和操作面板指令，上位機指令包括參數(shù)設置、參數(shù)讀取、自動加壓和壓力瀉零；操作面板指令為活塞復位；每個定時周期單片機控制軟件向上位機發(fā)送壓力釜內(nèi)的壓力。系統(tǒng)主要工作流程圖如圖6所示。

圖6中，主要列出了自動加壓、壓力瀉零和活塞復位工作流程圖，為保證系統(tǒng)安全，每次自動加壓前必須讀取壓力傳感器，若過壓則不執(zhí)行加壓指令；每次自動加壓后也必須讀取壓力傳感器，若達到門限則停止加壓；單片機控制軟件接收到電機報警后立刻停止加壓。

圖6　系統(tǒng)主要工作流程圖

4　結(jié)論

通過現(xiàn)場試驗調(diào)試，基于MSP430單片機控制的伺服電機控制系統(tǒng)運行良好，整個系統(tǒng)非常簡潔、模塊化設計易于調(diào)試、擴展應用性強而且低成本。基于該設計的深度模擬系統(tǒng)，經(jīng)調(diào)試能正常穩(wěn)定地工作，且性能良好。后續(xù)可考慮將該系統(tǒng)應用于其他工業(yè)設計中。

參考文獻：

［1］黃燦燦.基于PLC的脈沖磁體繞線機伺服電機控制系統(tǒng)的設計與實現(xiàn)［D］.武漢：華中科技大學，2011.

［2］李紅偉，胡濤，徐熙平，等.基于單片機的伺服電機控制系統(tǒng)的研究［J］.長春理工大學學報：自然科學版，2012，35（1）：116.

［3］胥開芳，蔡志濤.基于MSP430的智能測量表設計［J］.機電工程技術(shù)，2014（6）：86-89.

［4］趙磊，王哈力，何緒鋒，等.基于單片機交流伺服電機轉(zhuǎn)速控制系統(tǒng)研究［J］.現(xiàn)代電子技術(shù)，2009（16）：197.

(編輯：向飛)

Research on Servo-Motor Control System Based on SCM of MSP430

LI Cai-ju
（710 R&D Institute，CSIC，Yichang443003，China）

Abstract:The paper provides a scheme to control AC servo-motor based on single-chip Microcomputer of MSP430，which is the core controller of the system. The system design includes the hardware design and software design，which can realize the smooth control of the AC servo-motor speed. The scheme was used successfully in the depth simulation system. Motor rotation driving adding pressure equipment，can simulate any depth environment in the high pressure kettle.

Key words:SCM of MSP430；AC servo-motor；speed control；depth simulation system

作者簡介：李彩菊，女，1984年生，湖北長陽人，碩士，工程師。研究領域：信息與控制、信號處理。

收稿日期：2015－05－13

DOI:10. 3969 / j. issn. 1009-9492. 2015. 11. 021

中圖分類號：TP368.1

文獻標識碼：A

文章編號：1009－9492 ( 2015 ) 11－0077－04