王蘇洲, 舒志兵, 李 照

(南京工業(yè)大學(xué) 電氣工程與控制科學(xué)學(xué)院,江蘇 南京 211816)

基于STM32+CPLD全數(shù)字同步伺服驅(qū)動(dòng)器的設(shè)計(jì)與實(shí)現(xiàn)

王蘇洲, 舒志兵, 李 照

(南京工業(yè)大學(xué) 電氣工程與控制科學(xué)學(xué)院,江蘇 南京 211816)

以通用的高性能伺服驅(qū)動(dòng)器為研究對(duì)象，選用STM32+CPLD作為控制芯片，采用轉(zhuǎn)子磁場(chǎng)定向及空間矢量脈寬調(diào)制技術(shù)，詳細(xì)介紹了伺服驅(qū)動(dòng)器的硬、軟件設(shè)計(jì)，提出了一款全數(shù)字、高性能的永磁同步伺服驅(qū)動(dòng)器的設(shè)計(jì)方案。其中，針對(duì)伺服系統(tǒng)的速度控制器設(shè)計(jì)了一種PDFF算法，并對(duì)PDFF算法進(jìn)行了測(cè)試驗(yàn)證。最后，搭建測(cè)試平臺(tái)，對(duì)伺服驅(qū)動(dòng)器進(jìn)行性能測(cè)試。通過(guò)與日本安川Σ-7伺服驅(qū)動(dòng)器測(cè)試結(jié)果進(jìn)行對(duì)比，驗(yàn)證該伺服驅(qū)動(dòng)器設(shè)計(jì)的可行性與有效性。

伺服驅(qū)動(dòng)器；STM32；復(fù)雜可編程邏輯器件；矢量控制

0 引 言

伴隨著計(jì)算機(jī)控制、電力電子、傳感器、電機(jī)控制等技術(shù)的進(jìn)步，伺服驅(qū)動(dòng)技術(shù)也得到了迅猛發(fā)展。伺服驅(qū)動(dòng)器在經(jīng)歷了模擬式、模數(shù)混合式的發(fā)展后，如今已進(jìn)入全數(shù)字化的發(fā)展時(shí)期。全數(shù)字伺服彌補(bǔ)了模擬式伺服分散性大、零漂、低穩(wěn)定性等缺點(diǎn)，發(fā)揮了數(shù)字控制在控制精度上的優(yōu)勢(shì)和控制方法的靈活性，使伺服驅(qū)動(dòng)器不僅結(jié)構(gòu)簡(jiǎn)單，而且性能更加可靠。交流永磁同步電機(jī)因其結(jié)構(gòu)簡(jiǎn)單、運(yùn)行可靠等優(yōu)點(diǎn)，其矢量控制系統(tǒng)能夠?qū)崿F(xiàn)高精度、高動(dòng)態(tài)性能、大范圍的速度和位置控制，越來(lái)越受到人們的關(guān)注[1]。

本文設(shè)計(jì)了一款高性能的永磁同步伺服驅(qū)動(dòng)器，傳統(tǒng)上，在伺服驅(qū)動(dòng)技術(shù)中，大多采用計(jì)算能力較強(qiáng)的DSP作為控制核心[2]，但DSP的市場(chǎng)價(jià)格相對(duì)較高。本文采用STM32F103Z作為主控制芯片，以CPLD作為輔助控制芯片，簡(jiǎn)化了伺服驅(qū)動(dòng)器的軟、硬件設(shè)計(jì)，減小了控制系統(tǒng)的體積[3-5]，在一定程度上降低成本，因其具有較高的代碼效率，能夠高效地控制伺服電機(jī)，所以在國(guó)內(nèi)伺服市場(chǎng)競(jìng)爭(zhēng)中占得一定優(yōu)勢(shì)。

1 伺服驅(qū)動(dòng)器控制原理

1. 1 矢量控制基本思路

本文設(shè)計(jì)的交流伺服系統(tǒng)是典型的三環(huán)控制結(jié)構(gòu),即電流環(huán)、速度環(huán)和位置環(huán)[6-8]。電流環(huán)通過(guò)改造內(nèi)環(huán)控制的對(duì)象，系統(tǒng)的快速性得到了很大提高，并對(duì)抑制電流環(huán)內(nèi)的干擾十分有效。速度環(huán)可以增強(qiáng)整個(gè)系統(tǒng)的抗負(fù)載擾動(dòng)能力。高精度的位置環(huán)可實(shí)現(xiàn)位置和角度的低誤差跟蹤控制。所以，要設(shè)計(jì)出高性能的交流伺服系統(tǒng)，對(duì)各環(huán)的具體情況必須采取合理的控制策略。通常，永磁同步電機(jī)三閉環(huán)矢量控制系統(tǒng)的結(jié)構(gòu)如圖1所示。

圖1 三閉環(huán)矢量控制系統(tǒng)結(jié)構(gòu)圖

永磁同步電機(jī)伺服系統(tǒng)采用矢量控制時(shí)，dq坐標(biāo)系下永磁同步電機(jī)的狀態(tài)方程和轉(zhuǎn)矩公式如下：

(1)

(2)

式中: P——微分算子；p——電機(jī)極對(duì)數(shù)；ψf——轉(zhuǎn)子的磁鏈。

在式(2)中，ψf雖然受到永磁體溫度、磁路飽和等因素的影響，但所受影響很小，ψf基本保持不變。因此，電機(jī)電磁轉(zhuǎn)矩控制的本質(zhì)就是控制定子電流在dq坐標(biāo)系下的分量iq。永磁同步電機(jī)的控制通常采用id=0控制策略。這種控制方式的優(yōu)點(diǎn)就是減小銅耗，達(dá)到電機(jī)的最大效率。電磁轉(zhuǎn)矩正比于定子電流，在dq坐標(biāo)系下，只要精確地控制iq，就能準(zhǔn)確地控制電磁轉(zhuǎn)矩。

1. 2 電流控制器設(shè)計(jì)

在永磁同步電機(jī)伺服系統(tǒng)中電流控制的結(jié)構(gòu)一般情況下是固定的，電流環(huán)以逆變器和電機(jī)的電樞回路為控制對(duì)象。伺服驅(qū)動(dòng)系統(tǒng)的機(jī)械慣性比電機(jī)繞組回路的電磁慣性大很多，即電流響應(yīng)比轉(zhuǎn)速響應(yīng)快很多，所以旋轉(zhuǎn)電動(dòng)勢(shì)對(duì)電流控制環(huán)的影響可以被忽略，將旋轉(zhuǎn)電動(dòng)勢(shì)耦合項(xiàng)看作擾動(dòng)項(xiàng)，電機(jī)就可以看作一階慣性環(huán)節(jié)。對(duì)于一階慣性環(huán)節(jié)，引入PI調(diào)節(jié)器可以將其校正成為典型的I型環(huán)節(jié)，因此電流控制器采用PI調(diào)節(jié)器。

1. 3 速度控制器設(shè)計(jì)

在永磁同步伺服系統(tǒng)中，速度控制器大多采用傳統(tǒng)的PI控制算法，但傳統(tǒng)的PI控制算法難以同時(shí)兼顧系統(tǒng)的響應(yīng)速度和超調(diào)。在此，本文再提出一種PDFF控制算法，可以有效地控制超調(diào)，使得速度階躍響應(yīng)更加平穩(wěn)。

帶前饋增益的偽微分反饋，其本質(zhì)是對(duì)傳統(tǒng)PI的改進(jìn)型算法。PDFF控制算法的數(shù)學(xué)公式如下：

(3)

式中:Ki——積分增益；Kp——比例增益；Kfr——前饋增益。

由式(3)可知，當(dāng)Kfr=1時(shí)，該算法就變成了典型的PI控制算法，此時(shí)系統(tǒng)的響應(yīng)較快，但是DC剛度較差，超調(diào)較大；當(dāng)Kfr=0時(shí)，該算法就變成了另一種PI改進(jìn)型算法，即PDF控制算法，PDF算法具有良好的DC剛度，超調(diào)較小，但是系統(tǒng)響應(yīng)較慢；當(dāng)0

圖2 PDFF算法模型

圖3為PDFF算法仿真結(jié)果。從圖3可以看出，當(dāng)Kfr=1時(shí)，為典型的PI控制算法，此時(shí)系統(tǒng)的速度階躍響應(yīng)時(shí)間短，動(dòng)態(tài)性能好，但是超調(diào)較大；當(dāng)Kfr=0時(shí)，為PDF控制算法，此時(shí)系統(tǒng)的速度階躍響應(yīng)較為緩慢，調(diào)整時(shí)間較長(zhǎng)，動(dòng)態(tài)性能相對(duì)于PI算法較差，但是速度階躍響應(yīng)曲線(xiàn)很平滑，沒(méi)有產(chǎn)生超調(diào)；當(dāng)為PDFF控制算法時(shí)，本文取Kfr=0.65，由圖3可見(jiàn)，速度階躍響應(yīng)曲線(xiàn)介于PI和PDF之間，此時(shí)，系統(tǒng)既有較好的動(dòng)態(tài)性能，又有平滑的響應(yīng)過(guò)程，沒(méi)有超調(diào)。PDFF算法同時(shí)兼顧了動(dòng)態(tài)性能和超調(diào)，使伺服系統(tǒng)達(dá)到“快、準(zhǔn)、穩(wěn)”的控制要求。

圖3 PDFF算法仿真

1. 4 位置控制器設(shè)計(jì)

位置控制器采用速度前饋控制。比例增益增大可以減小位置滯后量，但是如果比例增益過(guò)度增大就會(huì)導(dǎo)致系統(tǒng)發(fā)生位置超差，即發(fā)生過(guò)沖，而采用速度前饋控制可以在不增加位置環(huán)增益的前提下，較大地減少跟蹤誤差，同時(shí)速度前饋控制可以縮短定位時(shí)間。位置環(huán)前饋濾波時(shí)間常數(shù)可以提高位置控制響應(yīng)，過(guò)大則會(huì)造成系統(tǒng)不穩(wěn)定，產(chǎn)生振蕩。

2 伺服驅(qū)動(dòng)器硬件設(shè)計(jì)

伺服驅(qū)動(dòng)器的硬件設(shè)計(jì)主要包括功率板和控制板兩塊。功率板主要包括智能功率模塊(Intelligent Power Module,IPM)及其接口電路、開(kāi)關(guān)電源電路、電流檢測(cè)電路等；控制板主要包括控制芯片、編碼器接口電路、CAN總線(xiàn)通信電路、空間矢量脈寬調(diào)制(Space Vector Pulse Width Modulation,SVPWM)信號(hào)處理電路等。本文IPM采用三菱公司的PS21869，控制芯片采用高性能的32位STM32，并用CPLD作為輔助控制芯片。伺服驅(qū)動(dòng)器的硬件結(jié)構(gòu)圖如圖4所示。

圖4 伺服驅(qū)動(dòng)器硬件結(jié)構(gòu)圖

2. 1 功率板

IPM是一種集成度很高的開(kāi)關(guān)功率器件，作為智能功率器件，IPM是把功率器件和控制、驅(qū)動(dòng)、保護(hù)電路一體化的功率模塊，現(xiàn)已被廣泛應(yīng)用于伺服驅(qū)動(dòng)器的設(shè)計(jì)中。在此，本設(shè)計(jì)選擇了三菱公司的PS21869。該IPM采用第五代低功耗IGBT，集成了優(yōu)化后的柵極驅(qū)動(dòng)和保護(hù)電路，額定輸入為600 V/50 A，最高可以承受600 V電壓，50 A電流，最大開(kāi)關(guān)頻率為20 kHz。

伺服驅(qū)動(dòng)器的功率電路通常采用交-直-交的結(jié)構(gòu)。電壓型逆變電路外接AC 220 V電源。在整流橋與輸入電源端子之間加入了電源濾波器，其主要作用是濾除高于交流電頻率的那部分電流，起到抗干擾的目的。經(jīng)過(guò)浪涌吸收電路出來(lái)的交流電進(jìn)入整流橋，實(shí)現(xiàn)AC到DC的轉(zhuǎn)化。直流電經(jīng)過(guò)軟起動(dòng)電路，供給IPM，作為IPM電源輸入。軟起動(dòng)電路中，在發(fā)生斷電的瞬間，繼電器電感會(huì)產(chǎn)生一個(gè)較大的逆電勢(shì)，與電源疊加后會(huì)對(duì)控制部分造成較大沖擊。為了避免該沖擊，選擇在繼電器側(cè)并聯(lián)一個(gè)二極管。

定子電流檢測(cè)采用光電隔離放大器芯片HCPL7840。該芯片的工作原理如下：通過(guò)外接一個(gè)采樣電阻，將電流信號(hào)轉(zhuǎn)化為電壓信號(hào)，該輸出差分電壓和定子電流成正比，所以只要得到輸出電壓，就能得到定子電流。采樣電阻的感值較小，有助于提高采樣電路的快速性和靈敏性。

2. 2 控制板

本文采用STM32F103Z作為主控制芯片，以CPLD作為輔助控制芯片，簡(jiǎn)化了伺服驅(qū)動(dòng)器的軟硬件設(shè)計(jì)，減小了控制系統(tǒng)的體積，在一定程度上降低了成本。

采用增量式編碼器，分辨率為2 500線(xiàn)。編碼器接口用于檢測(cè)編碼器產(chǎn)生的表征電機(jī)轉(zhuǎn)子位置的脈沖，其提供了A、B、Z和U、V、W 6相一共12路的差分脈沖信號(hào)，用來(lái)反饋電機(jī)轉(zhuǎn)子的角位移和轉(zhuǎn)速信息。通過(guò)A、B脈沖的相位關(guān)系可以確定電機(jī)的旋轉(zhuǎn)方向，通過(guò)標(biāo)志脈沖Z可以確定電機(jī)的旋轉(zhuǎn)圈數(shù)，通過(guò)計(jì)算采樣周期內(nèi)編碼器的脈沖增量可以計(jì)算得到電機(jī)轉(zhuǎn)速。在控制板上，通過(guò)芯片26LS31將這12路信號(hào)轉(zhuǎn)換成單端輸入脈沖。

SVPWM信號(hào)通過(guò)光耦輸出，經(jīng)過(guò)6通道的施密特反相器整形后得到PUP、PUN、PVP、PVN、PWP、PWN，將這6路信號(hào)送入IPM的控制輸入端。IPM的故障信號(hào)經(jīng)過(guò)光耦PC817隔離之后，給到控制板。IPM的內(nèi)部驅(qū)動(dòng)電路需要+15 V的電源，該電源由開(kāi)關(guān)電源電路提供。

CAN總線(xiàn)現(xiàn)在已經(jīng)被廣泛應(yīng)用于工業(yè)領(lǐng)域。在伺服驅(qū)動(dòng)器上，CAN總線(xiàn)技術(shù)也日漸成熟。STM21F103Z內(nèi)部集成了增強(qiáng)型的CAN總線(xiàn)通信接口，該接口符合CAN2.0B標(biāo)準(zhǔn)，且內(nèi)核具有完整的CAN通信協(xié)議，易于開(kāi)發(fā)。

3 伺服驅(qū)動(dòng)器軟件設(shè)計(jì)

3. 1 主程序

系統(tǒng)的主程序主要用于完成初始化和主循環(huán)。初始化包括系統(tǒng)初始化、轉(zhuǎn)子位置初始化,以及控制參數(shù)初始化。主程序的流程圖如圖5所示。

圖5 主程序流程圖

3. 2 中斷服務(wù)程序

圖6 主中斷服務(wù)程序流程圖

當(dāng)進(jìn)入主中斷服務(wù)程序(見(jiàn)圖6)后，定時(shí)器開(kāi)始工作，首先對(duì)定子電流進(jìn)行采樣，并讀取轉(zhuǎn)子的初始位置信息，進(jìn)而判斷伺服驅(qū)動(dòng)器控制方式的設(shè)定。如果為位置控制方式，則接收上位系統(tǒng)的位置指令，并計(jì)算實(shí)際位置與指令位置的偏差，將偏差給到位置控制器，由位置控制器進(jìn)行計(jì)算，得到速度指令，從而進(jìn)入速度環(huán)，進(jìn)行速度控制；若控制方式不是位置控制方式，則檢測(cè)是否為速度控制方式。在速度控制方式下，將速度指令和實(shí)際測(cè)量計(jì)算得到的速度進(jìn)行比較，并通過(guò)速度控制器進(jìn)行調(diào)節(jié)，產(chǎn)生電流指令，最后進(jìn)入電流環(huán)；經(jīng)過(guò)坐標(biāo)變換和電流控制器計(jì)算，得到輸出電流。

4 伺服驅(qū)動(dòng)器性能測(cè)試

在介紹了軟、硬件設(shè)計(jì)，并對(duì)控制算法進(jìn)行了改進(jìn)后，對(duì)本文設(shè)計(jì)的伺服驅(qū)動(dòng)器進(jìn)行性能測(cè)試，采用對(duì)拖的方式，對(duì)電流、速度及位置三個(gè)環(huán)進(jìn)行性能測(cè)試，并與性能較好的日本安川Σ-7伺服驅(qū)動(dòng)器測(cè)試結(jié)果進(jìn)行對(duì)比，驗(yàn)證本文設(shè)計(jì)的伺服器性能是否達(dá)到指標(biāo)。該測(cè)試平臺(tái)主要由待測(cè)伺服驅(qū)動(dòng)器、華大電機(jī)、安川伺服驅(qū)動(dòng)器、安川電機(jī)、信號(hào)發(fā)生器、示波器及計(jì)算機(jī)組成。其中，華大電機(jī)和安川電機(jī)通過(guò)聯(lián)軸器相連接，待測(cè)驅(qū)動(dòng)器接華大電機(jī)，安川驅(qū)動(dòng)器接安川電機(jī)。

4. 1 電流環(huán)響應(yīng)測(cè)試

對(duì)于整個(gè)伺服系統(tǒng)而言，要保證系統(tǒng)的響應(yīng)特性和控制精度，必須首先保證內(nèi)環(huán)電流環(huán)的響應(yīng)特性和控制精度。對(duì)于電流環(huán)的測(cè)試，主要是測(cè)試電流的階躍響應(yīng)，重點(diǎn)看電流的響應(yīng)時(shí)間與電流超調(diào)兩個(gè)指標(biāo)。本文的設(shè)計(jì)目標(biāo)是使電機(jī)電流環(huán)的響應(yīng)時(shí)間小于5 ms，電流超調(diào)量小于5%。

待測(cè)驅(qū)動(dòng)器接線(xiàn)完成后上電，首先將安川驅(qū)動(dòng)器設(shè)定為內(nèi)部轉(zhuǎn)矩限制并使能，安川電機(jī)的轉(zhuǎn)軸是鎖死的，由于通過(guò)聯(lián)軸器連接，華大電機(jī)的轉(zhuǎn)軸同樣被鎖住。設(shè)定待測(cè)驅(qū)動(dòng)器的控制方式為轉(zhuǎn)矩控制方式，即P0004設(shè)為2。測(cè)試所用的指令信號(hào)由模擬量提供，通過(guò)12(Vin)和13(AGND)兩個(gè)腳外接一個(gè)電位計(jì)實(shí)現(xiàn)，模擬量的大小為0～+10 V，0 V對(duì)應(yīng)空載，10 V對(duì)應(yīng)額定轉(zhuǎn)矩。模擬量大小與電機(jī)轉(zhuǎn)矩呈線(xiàn)性關(guān)系，在本測(cè)試中，電位計(jì)的電位給定10 V。通過(guò)按鈕按下，電機(jī)的定子電流就會(huì)發(fā)生突變，以此來(lái)實(shí)現(xiàn)階躍響應(yīng)的效果。使用電流鉗測(cè)量電機(jī)U、V、W的任意一相的電流，通過(guò)示波器即可得到電流環(huán)的響應(yīng)曲線(xiàn)。

同理，安川驅(qū)動(dòng)器電流環(huán)響應(yīng)測(cè)試的具體步驟同上。經(jīng)測(cè)量，兩款驅(qū)動(dòng)器的電流環(huán)響應(yīng)如圖7、圖8所示。

圖7 待測(cè)驅(qū)動(dòng)器電流階躍響應(yīng)

圖8 安川驅(qū)動(dòng)器電流階躍響應(yīng)

從圖7可以看出，示波器的橫坐標(biāo)每格為1 ms，待測(cè)驅(qū)動(dòng)器的電流環(huán)響應(yīng)時(shí)間約為3 ms，顯然已經(jīng)達(dá)到了5 ms的設(shè)計(jì)要求，電流響應(yīng)沒(méi)有明顯的超調(diào)，也滿(mǎn)足了超調(diào)量小于5%的設(shè)計(jì)要求。圖8為安川Σ-7驅(qū)動(dòng)器的電流環(huán)響應(yīng)曲線(xiàn)，電流環(huán)的響應(yīng)時(shí)間約為2.5 ms，同樣沒(méi)有明顯超調(diào)。從電流環(huán)來(lái)看，本文設(shè)計(jì)的伺服驅(qū)動(dòng)器和安川伺服驅(qū)動(dòng)器相比，在電流響應(yīng)時(shí)間上稍慢一些，但達(dá)到了設(shè)計(jì)要求。

4. 2 速度環(huán)響應(yīng)測(cè)試

速度環(huán)主要是為了保證整個(gè)伺服系統(tǒng)在工作過(guò)程中速度的穩(wěn)定性，對(duì)于速度環(huán)響應(yīng)的測(cè)試，主要是測(cè)量速度的響應(yīng)時(shí)間與速度超調(diào)量?jī)蓚€(gè)指標(biāo)。本文的設(shè)計(jì)目標(biāo)是速度響應(yīng)時(shí)間小于20 ms，速度超調(diào)量小于5%。

接線(xiàn)完成后上電，設(shè)定待測(cè)驅(qū)動(dòng)器的參數(shù)為速度控制方式，即P0004設(shè)為1，安川驅(qū)動(dòng)器不使能。使用模擬量信號(hào)作為待測(cè)驅(qū)動(dòng)器的速度指令輸入，大小為0～10 V，10 V對(duì)應(yīng)電機(jī)的額定轉(zhuǎn)速，本測(cè)試所用華大電機(jī)的額定轉(zhuǎn)速為2 500 r/min。將電位計(jì)的幅值給定位5 V，按下按鈕，利用示波器捕捉電機(jī)的階躍響應(yīng)過(guò)程。

同理，安川驅(qū)動(dòng)器的速度環(huán)響應(yīng)測(cè)試過(guò)程與上述測(cè)試過(guò)程一致。

測(cè)量得到兩款伺服驅(qū)動(dòng)器的速度環(huán)響應(yīng)如圖9、圖10所示。

圖9 待測(cè)驅(qū)動(dòng)器速度階躍響應(yīng)

圖10 安川驅(qū)動(dòng)器速度階躍響應(yīng)

圖9中，示波器橫坐標(biāo)為時(shí)間，每格為10 ms，縱坐標(biāo)表示電機(jī)轉(zhuǎn)速，從0到1 250 r/min，一共5格，每格代表250 r/min。待測(cè)驅(qū)動(dòng)器的速度環(huán)響應(yīng)時(shí)間約為10 ms，達(dá)到了本文的設(shè)計(jì)目標(biāo)；從圖9可以得到在響應(yīng)過(guò)程中的最大轉(zhuǎn)速為1 300 r/min，通過(guò)計(jì)算可以得到速度的超調(diào)量：

(4)

通過(guò)計(jì)算可以發(fā)現(xiàn)超調(diào)量小于5%，也滿(mǎn)足了本文的設(shè)計(jì)目標(biāo)。

同理，通過(guò)圖10可以得到安川伺服驅(qū)動(dòng)器的速度環(huán)響應(yīng)時(shí)間也約為10 ms,超調(diào)量約為4%。通過(guò)測(cè)試驗(yàn)證了，本文設(shè)計(jì)的伺服驅(qū)動(dòng)器的速度環(huán)響應(yīng)與安川伺服驅(qū)動(dòng)器的速度環(huán)響應(yīng)比較接近。

在圖9中，本文的伺服驅(qū)動(dòng)器的速度環(huán)依然采用的是傳統(tǒng)的PI控制算法，前文設(shè)計(jì)了一種PDFF控制算法，在此，將會(huì)對(duì)設(shè)計(jì)的PDFF控制算法進(jìn)行測(cè)試，驗(yàn)證該算法的合理性與可行性。

設(shè)定待測(cè)驅(qū)動(dòng)器的速度環(huán)PDFF控制系數(shù)，本文給定前饋增益Kfr=0.65，即設(shè)定參數(shù)P018為65，此時(shí)的速度環(huán)控制器由傳統(tǒng)PI控制器變成了PDFF控制器。具體的測(cè)試過(guò)程同前文所述。

從圖11可看出，使用了PDFF算法的速度環(huán)響應(yīng)時(shí)間約為20 ms，沒(méi)有發(fā)現(xiàn)明顯的超調(diào)，說(shuō)明PDFF算法設(shè)計(jì)的速度控制器依然滿(mǎn)足本文對(duì)于速度環(huán)的設(shè)計(jì)要求，相比于PI算法，PDFF算法的超調(diào)量明顯減小，但是響應(yīng)時(shí)間卻延長(zhǎng)了。

圖11 PDFF速度階躍響應(yīng)

再將圖11與圖3對(duì)比可以發(fā)現(xiàn)，仿真和試驗(yàn)得到的PDFF算法均沒(méi)有明顯超調(diào)，但響應(yīng)時(shí)間均比PI算法有所延長(zhǎng)。試驗(yàn)測(cè)量的結(jié)果與仿真得到的結(jié)果一致，就驗(yàn)證了該P(yáng)DFF算法的設(shè)計(jì)是合理的、可行的。

4. 3 位置精度測(cè)試

伺服系統(tǒng)的一個(gè)基本要求就是“準(zhǔn)”，要求定位精確。本文的設(shè)計(jì)要求是位置誤差小于0.15%，在此，對(duì)本文設(shè)計(jì)的伺服驅(qū)動(dòng)器進(jìn)行定位精度測(cè)試。

接線(xiàn)完成后，CN1插頭需要接入位置指令脈沖PLUS+和PLUS-，以及位置指令方向SIGN+和SIGN-，模擬量引腳Vin和AGND不需要接。利用測(cè)試軟件給驅(qū)動(dòng)器發(fā)送指令，規(guī)劃路徑，得到結(jié)果如圖12所示。

圖12 位置跟隨性測(cè)試

圖12為位置跟隨曲線(xiàn)。圖12中，橫坐標(biāo)為時(shí)間，縱坐標(biāo)為脈沖增量。通過(guò)對(duì)比橫坐標(biāo)可以發(fā)現(xiàn)，實(shí)際位置曲線(xiàn)較位置指令曲線(xiàn)約有5 ms的延時(shí)；通過(guò)縱坐標(biāo)可以看出，定位誤差約有2.607個(gè)脈沖增量。本測(cè)試使用的編碼器為增量式編碼器，分辨率為2 500線(xiàn)，電機(jī)每轉(zhuǎn)一圈會(huì)產(chǎn)生10 000個(gè)脈沖，按照本文的設(shè)計(jì)要求，位置誤差小于0.15%，則10 000個(gè)脈沖最大誤差為15個(gè)脈沖增量，誤差為2.607，顯然達(dá)到了本文的設(shè)計(jì)要求。

5 結(jié) 語(yǔ)

以STM32芯片為控制核心，設(shè)計(jì)了伺服驅(qū)動(dòng)器的軟、硬件，完成了一款高性能交流同步伺服驅(qū)動(dòng)器的設(shè)計(jì)。最后通過(guò)與日本安川Σ-7伺服驅(qū)動(dòng)器測(cè)試結(jié)果進(jìn)行對(duì)比，驗(yàn)證該伺服驅(qū)動(dòng)器設(shè)計(jì)的可行性與有效性。

[1] 李壯云.液壓元件與系統(tǒng)[M].北京: 機(jī)械工業(yè)出版社,2005.

[2] 孫祖勇.基于DSP的全數(shù)字交流永磁伺服系統(tǒng)的研究[D].南京: 南京航空航天大學(xué),2008.

[3] 杜方.交流永磁同步電機(jī)變結(jié)構(gòu)控制器設(shè)計(jì)與研究[D].武漢: 華中科技大學(xué),2013.

[4] 姚曉先.伺服系統(tǒng)設(shè)計(jì)[M].北京: 機(jī)械工業(yè)出版社,2013.

[5] 肖永清.談工業(yè)控制電氣伺服驅(qū)動(dòng)技術(shù)及其發(fā)展[J].機(jī)床電器,2012,39(5): 4-9.

[6] 張涌松.基于DSP的永磁同步電機(jī)控制系統(tǒng)研究[D].南京: 南京工業(yè)大學(xué),2010.

[7] KAZANTSEV V P, DADENKOV D A. Position-servo drives with finite control[J]. Russian Electrical Engineering, 2015, 86(6): 344-349.

[8] 杜方.交流永磁同步電機(jī)變結(jié)構(gòu)控制器設(shè)計(jì)與研究[D].武漢: 華中科技大學(xué),2013.

Design and Implementation of Digital Synchronous Servo Driver Based on STM32 and CPLD

WANGSuzhou,SHUZhibing,LIZhao

(College of Electrical Engineering and Control Science, Nanjing Tech University, Nanjing 211816, China)

Used general high performance servo drive as the research object, select STM32 and CPLD as controlling core and used FOC and SVPWM technology. The hardware and software design of the servo drive was introduced, a design scheme of full digital and high performance servo driver was proposed. For servo system speed controller was designed and a PDFF algorithm, and tests had been carried out to verify the PDFF algorithm. Finally, the testing platform was built, tested the performance of servo driver and verified if the requirements were met. With Japan yaskawa Σ-7 servo driver, comparing the test results verified the feasibility and effectiveness of the servo driver design.

servo driver; STM32; complex programmable logic device (CPLD); vector control

王蘇洲(1990—)，男，碩士研究生,研究方向?yàn)榻涣魉欧到y(tǒng)、數(shù)控系統(tǒng)、運(yùn)動(dòng)控制、機(jī)電一體化系統(tǒng)等。

TM 301.2

A

1673-6540(2017)04- 0074- 06

2016 -07 -11