基于FPGA的無人機(jī)電調(diào)模塊的設(shè)計

吉林大學(xué) 李欣序 劉 豫 袁 培 紀(jì)永成

基于FPGA的無人機(jī)電調(diào)模塊的設(shè)計

吉林大學(xué) 李欣序 劉 豫 袁 培 紀(jì)永成

本設(shè)計分析了無刷直流電機(jī)的工作原理，依據(jù)工作原理，提出了一種全數(shù)字化的無人機(jī)無刷直流電機(jī)速度控制并驅(qū)動的方案，并且利用京微雅閣公司的FPGA開發(fā)板完成了電機(jī)控制器的設(shè)計、制作和調(diào)試。該方案綜合運(yùn)用了FPGA豐富的邏輯資源，針對電動機(jī)信號檢測和控制的特點，采用verilog語言實現(xiàn)了PID控制器、PWM產(chǎn)生、速度檢測、換相控制的設(shè)計，整個系統(tǒng)響應(yīng)速度快、可靠性高、靈活性強(qiáng)，實現(xiàn)了全數(shù)字控制。

FPGA；無刷直流電機(jī)；PID控制器；PWM模塊

1. 引言

無人機(jī)的電機(jī)是由電調(diào)驅(qū)動的，也是無人機(jī)的重要部分。傳統(tǒng)的無人機(jī)電調(diào)主要是由單片機(jī)、ARM等實現(xiàn)的。采用基于FPGA設(shè)計無人機(jī)電調(diào)，充分利用了FPGA并行數(shù)據(jù)處理能力和同步設(shè)計優(yōu)勢，將大部分功能模塊都集成在FPGA芯片內(nèi)部，外圍電路僅僅包含了電平轉(zhuǎn)換和驅(qū)動電路等簡單電路，避免了MCU等單指令周期芯片的時序特點，系統(tǒng)硬件結(jié)構(gòu)簡單，擴(kuò)展性更強(qiáng)。能夠滿足各種類型無人機(jī)的實時遠(yuǎn)程控制要求。

本設(shè)計系統(tǒng)框圖如圖1所示，是一個閉環(huán)反饋系統(tǒng)，控制量是從FPGA開發(fā)板的鍵盤上輸入的，與無刷直流電機(jī)反饋回的速度值經(jīng)過PID算法的修正，輸入到PWM波產(chǎn)生模塊中，產(chǎn)生有特定占空比的PWM信號，與霍爾傳感器反饋回的三路霍爾信號共同輸入到換相控制模塊中，產(chǎn)生實時的電機(jī)換相信號，輸出給硬件驅(qū)動電路，從而驅(qū)動無刷直流電機(jī)。

圖1 無人機(jī)電調(diào)模塊原理圖

圖2 三相功率橋電路以及位置檢測電路

2. 系統(tǒng)硬件電路設(shè)計方案

本設(shè)計選用的是自帶數(shù)字型霍爾傳感器的無刷直流電機(jī)，電極對數(shù)為1，可反饋三路Ha、Hb、Hc霍爾信號。額定轉(zhuǎn)速為3000r/ min，額定電壓為24V。硬件電路部分包括功率橋電路，位置檢測電路和驅(qū)動電路。本設(shè)計所使用的是三相功率逆變橋電路，如圖2左所示，三相逆變功率橋電路采用6個MOSFET搭建而成的三相橋式逆變器，由于其開關(guān)速度快，適合中小功率開關(guān)電路。這種結(jié)構(gòu)可以將直流驅(qū)動信號轉(zhuǎn)換為三路交流信號，用來控制無刷直流電機(jī)的三極。位置檢測電路圖2右所示，用電容電阻進(jìn)行濾波，經(jīng)過三極管使5V霍爾信號反饋值變成3.3V反饋回給FPGA。驅(qū)動電路采用的是IR2132芯片，此芯片是利用電容充放電技術(shù)來驅(qū)動功率MOSFET設(shè)計的，由于其內(nèi)部驅(qū)動器的導(dǎo)通阻抗小，因此在MOSFET的柵極以及源極加入了電阻以保證更好的工作[1]。

3. 系統(tǒng)功能模塊的FPGA實現(xiàn)

無人機(jī)的電調(diào)模塊的控制器都集成在FPGA內(nèi)部，采用verilog語言編程，并在京微雅閣公司的Primance以及Modelsim軟件環(huán)境下進(jìn)行編譯和仿真。FPGA模塊主要包括：PID控制器模塊、PWM產(chǎn)生模塊、換相控制模塊、速度檢測模塊。

3.1 PID控制器

PID控制器是由比例單元P、積分單元I、微分單元D組成的，通過Kp、Ki、Kd三個參數(shù)的設(shè)定，對設(shè)定值與反饋值之差進(jìn)行調(diào)節(jié)，輸出控制量。PID控制是最早發(fā)展起來的控制算法之一，也是無刷直流電機(jī)控制系統(tǒng)最常采用的控制算法，數(shù)字PID控制算法是將模擬PID離散化得到，調(diào)整方便。本設(shè)計的PID控制器采用的是增量式控制器，根據(jù)PID算法公式（3.1）可以推出（3.2）。圖3為PID控制器的原理圖[2]。

圖3 PID控制器原理圖

3.2 PWM產(chǎn)生模塊

PWM產(chǎn)生模塊是基于計數(shù)比較法產(chǎn)生的，如4圖所示，系統(tǒng)時鐘信號為50MHz，進(jìn)行時鐘分頻后得到10KHz的時鐘，計數(shù)器cnt對10KHz時鐘進(jìn)行計數(shù)，當(dāng)計數(shù)器的計數(shù)值為0時，比較器1即圖中ab1輸出高電平，當(dāng)計數(shù)器的計數(shù)值達(dá)到占空比給定值d時，比較器2即圖中ab2輸出高電平，經(jīng)過SR鎖存器，輸出PWM波[3]。圖5為PWM模塊仿真結(jié)果。

圖4 PWM產(chǎn)生以及換相控制模塊

圖5 PWM模塊仿真波形圖

3.3 換相控制模塊

換相控制模塊是根據(jù)電機(jī)原理以及換相控制表得出的如圖6，三個霍爾傳感器互差120°對稱放置，輸出脈寬180°的三路霍爾位置信號，電機(jī)每旋轉(zhuǎn)360°會出現(xiàn)六個上升沿和下降沿，正好把三路位置信號在一個周期分成6個區(qū)間，每個區(qū)間對應(yīng)一個換相區(qū)間，每個上升沿和下降沿都對應(yīng)一個換相時刻[4]。換相控制模塊輸入的是PWM波以及位置三相霍爾信號（Ha、Hb、Hc），輸出6個電機(jī)換相以及速度控制脈沖。其中VT1～6分別控制六路MOSFET的開關(guān)，來決定電機(jī)的A+B+、A+C+、B+C+導(dǎo)通。圖7為換相控制模塊仿真結(jié)果圖[5]。

圖6 電機(jī)內(nèi)部原理圖

圖7 換相控制模塊仿真結(jié)果圖

3.4 速度檢測模塊

速度檢測模塊原理是在霍爾信號的一個周期內(nèi)對一個高頻時鐘進(jìn)行計數(shù)，計數(shù)器的計數(shù)值為cnt，時鐘周期為Ts，p為電極對數(shù)[6,7]。根據(jù)公式speed=60/(cnt*Ts*p)得出速度測量值，反饋給PID模塊。圖8、9分別為速度檢測模塊原理以及仿真結(jié)果[8]。

圖8 速度測量模塊原理

圖9 速度測量模塊仿真結(jié)果圖

4. 實驗結(jié)果及總結(jié)

本設(shè)計首先通過在理論對無刷直流電機(jī)調(diào)速系統(tǒng)電路進(jìn)行設(shè)計、分析、編寫代碼，并且對軟件和硬件進(jìn)行調(diào)試后，實現(xiàn)了以FPGA為核心控制器的無人機(jī)電機(jī)的調(diào)速系統(tǒng)，這個系統(tǒng)能夠?qū)崿F(xiàn)檢測電機(jī)的電流和轉(zhuǎn)子位置和自動調(diào)節(jié)電機(jī)轉(zhuǎn)速，該系統(tǒng)的運(yùn)行時鐘頻率50MHz，可以在極短時間內(nèi)電機(jī)速度達(dá)到設(shè)定值。

圖10 無人機(jī)電調(diào)實物圖

[1]任小青.基于FPGA的PWM控制器設(shè)計及應(yīng)用[D].西安科技大學(xué),2011.

[2]丁衛(wèi)東.基于FPGA的無刷直流電機(jī)驅(qū)動控制系統(tǒng)設(shè)計與實現(xiàn)[D]. 南京郵電大學(xué), 2011.

[3]敬光紅.基于FPGA的無刷直流電機(jī)數(shù)字控制方法研究[J].電子器件2016(1):111-117.

[4]李凡.基于FPGA的全數(shù)字無刷直流電機(jī)控制系統(tǒng)研究[D].重慶大學(xué), 2010.

[5]楊淼.基于FPGA的直流電機(jī)控制系統(tǒng)設(shè)計[D].華中科技大學(xué), 2014.

[6]Sathyan A, Milivojevic N,Lee Y J,et al.An FPGA-based novel digital PWM control scheme for BLDC motor drives[J]. IEEE transactions on industrial electronics, 2009, 56(8): 3040-3049.

[7]Milivojevic N,Krishnamurthy M,Gurkaynak Y,et al. Stability analysis of FPGA-based control of brushless DC motors and generators using digital PWM technique[J].IEEE transactions on industrial electronics, 2012, 59(1):343-351.

[8]Lai Y S,Shyu F S,Tseng S S.New initial position detection technique for three-phase brushless DC motor without position and current sensors[J]. IEEE Transactions on Industry Applications,2003, 39(2):485-491.

紀(jì)永成【通訊作者】（1981-），男，吉林人，吉林大學(xué)碩士研究生，工程師。

李欣序（1991-），女，黑龍江人，吉林大學(xué)碩士研究生。

劉 豫（1991-），男，遼寧人，吉林大學(xué)碩士研究生。

袁 培（1991-），女，河南人，吉林大學(xué)碩士研究生。