《優秀的IC/FPGA開源項目》是新開的系列,旨在介紹單一項目,會比《優秀的 Verilog/FPGA開源項目》內容介紹更加詳細,包括但不限于綜合、上板測試等。兩者相輔相成,互補互充~
作為一名工程師,在項目實施階段多多少少會遇到需要使用控制理論的應用程序。
一種非常常用的算法是比例積分微分控制器(proportional-integral-derivative control)或 PID 控制器。PID 算法用于控制各種應用中溫度、壓力、電機位置和流量等變量。我經常看到的一個地方是高端圖像處理系統(制冷型紅外),為了減少圖像中的噪點。它使用熱電冷卻器或其他冷卻系統來冷卻圖像傳感器。對于高端成像,較低的噪聲可以帶來更好的圖像。
介紹
PID 控制算法實現起來并不難,因為它只需要加法、乘法、除法和減法(dog)。但是,一旦算法實施,確保 PID 回路穩定的三個系數可能需要一點額外的時間來獲取。
PID 主要使用三個術語。
比例(Proportional) -測量期望值和測量值之間的差異。比例值是當前位置的量度。
積分(Integral) -會隨著時間的推移對誤差進行積分。積分項是誤差的歷史累積值。隨著誤差的消除,積分項停止增長。
導數(Derivative) -計算變化率并預測誤差的未來趨勢。
每個術語還具有相關的增益 KI、KP 或 KD,可以幫助我們調整 PID 控制器算法的行為。D 項不是必須的,而且簡單的情況下我們基本不使用,使用 PI 控制器也很常見。
PID經常使用浮點數來實現。因此,我們可以使用諸如 VHDL Fixed/Float 之類的庫在 RTL 中實現。或者,我們可以使用HLS來實現 PID,因為國內應用VHDL較少,所以我們今天的實例是使用HLS構建我們的PID算法。使用HLS能夠使用浮點或任意精度的定點數。HLS還能通過#pragma 快速的為IP添加通用控制接口(AXI)。
在純 FPGA 實現類似系統時候,我們需要添加軟核來控制IP。在較小的 Zynq-7000 SoC FPGA(7007、7010、7020 等)中則可以通過硬核控制IP。或者,如果我們設計中不想使用處理器,那我們可以設計傳統的矢量接口即可。
源碼設計
PID 的實際源代碼非常簡單,如下所示。
#include"pid.h" staticdata_typeerror_prev=0; staticdata_typei_prev=0; data_typePID(data_typeset_point,data_typeKP,data_typeKI,data_typeKD,data_typesample,data_typets,data_typepmax) { #pragmaHLSINTERFACEmode=s_axiliteport=return #pragmaHLSINTERFACEmode=s_axiliteport=sample #pragmaHLSINTERFACEmode=s_axiliteport=KD #pragmaHLSINTERFACEmode=s_axiliteport=KI #pragmaHLSINTERFACEmode=s_axiliteport=KP #pragmaHLSINTERFACEmode=s_axiliteport=set_point #pragmaHLSINTERFACEmode=s_axiliteport=ts #pragmaHLSINTERFACEmode=s_axiliteport=pmax data_typeerror,i,d,p; data_typetemp; data_typeop; error=set_point-sample; p=error*KP; i=i_prev+(error*ts*KI); d=KD*((error-error_prev)/ts); op=p+i+d; error_prev=error; if(op>pmax){ i_prev=i_prev; op=pmax; }else{ i_prev=i; } returnop; }
已將previous error和previous integral聲明為全局靜態變量,以確保它們在迭代時候其值保持不變。
在算法方面,用戶可以在應用程序運行時動態加載 KP、KI、KID、Ts 和 Pmax。我們可以輕松地添加積分值或使用附加寄存器重新啟動控制器。這將使 PID 可以用于多個實現。
為了測試和配置 PID,測試文件羅列了一系列溫度值,這些溫度都遠高于預期的目標設定點,并確保達到設定點。此示例中的 PID 設計用于提供功率(以瓦特為單位)維持光學床的溫度。在這種情況下,我們需要加熱而不是降低溫度。
#include"pid.h" #include#defineiterations40 intmain(void) { data_typeset_point=-80.0; data_typesample[iterations]={-90.000,-88.988,-87.977,-86.966,-85.955,-84.946,-83.936,-82.928,-81.920,-80.912,-80.283,-79.926,-79.784,-79.774,-79.829,-79.898,-79.955,-79.993,-80.011,-80.017,-80.016,-80.010,-80.005,-80.002,-80.000,-79.999,-79.999,-79.999,-79.999,-80.000,-80.000,-80.000,-80.000,-80.000,-80.000,-80.000,-79.999,-80.000,-80.001,-80.000}; data_typekp=19.6827;//w/k data_typeki=0.7420;//w/k/s data_typekd=0.0; data_typeop; printf("testingcpp "); for(inti=0;i
在 Vitis HLS 中針對該 PID 算法進行C 仿真和協同仿真,結果完全符合預期。
算法按照預期運行,下一步是綜合和導出 IP,最后就是添加到我們的 Vivado 項目中。這次我們使用的是ZYNQ FPGA。
延遲性能和資源消耗
下面的完整框圖反映了添加到Vivado項目中情況。
框圖
總設計資源
PID 資源
構建完成上面的Vivado項目,接下來就是導出硬件(XSA)到 Vitis 中開發驅動。
在 Vitis 中開發驅動時候,我重用了 HLS 仿真文件中的幾個元素。
由于我們使用的是 AXI 接口,Vitis HLS 在導出IP時候地為我們提供了一個可以在 Vitis 中用于驅動 IP 核的驅動程序。但是,當在 IP 內核中使用浮點輸入時,驅動程序則期望它們為 U32。如果我們在開發驅動時候從浮點數轉換為 U32,我們將失去準確性。因此,解決這個問題的方法是使用指針(pointers)和強制轉換。
本質上,我們將變量聲明為浮點數,然后在函數中調用設置一個指向浮點變量地址的 U32 指針,并使用間接運算符讀取該值。
XPid_Set_set_point(&pid,*((u32*)&set_point));
整個應用程序是
#include#include"platform.h" #include"xil_printf.h" #include"xpid.h" #defineiterations40 typedeffloatdata_type; data_typeset_point=-80.0; data_typesample[iterations]={-90.000,-88.988,-87.977,-86.966,-85.955,-84.946,-83.936,-82.928,-81.920,-80.912,-80.283,-79.926,-79.784,-79.774,-79.829,-79.898,-79.955,-79.993,-80.011,-80.017,-80.016,-80.010,-80.005,-80.002,-80.000,-79.999,-79.999,-79.999,-79.999,-80.000,-80.000,-80.000,-80.000,-80.000,-80.000,-80.000,-79.999,-80.000,-80.001,-80.000}; data_typekp=19.6827;//w/k data_typeki=0.7420;//w/k/s data_typekd=0.0; data_typets=12.5; data_typepmax=40; u32op; XPidpid; intmain() { floatresult; init_platform(); disable_caches(); print("AdiuvoPIDExample "); XPid_Initialize(&pid,XPAR_XPID_0_DEVICE_ID); XPid_Set_set_point(&pid,*((u32*)&set_point)); XPid_Set_KP(&pid,*((u32*)&kp)); XPid_Set_KI(&pid,*((u32*)&ki)); XPid_Set_KD(&pid,*((u32*)&kd)); XPid_Set_ts(&pid,*((u32*)&ts)); XPid_Set_pmax(&pid,*((u32*)&pmax)); u32tst=XPid_Get_set_point(&pid); for(inti=0;i
運行,得到以下結果。
正如預期的那樣,硬件中的實現與軟件的工作方式相同。
當然,對于不同的應用程序,我們需要重新確定可用于應用程序的 KP、KI 和 KD 變量。
這樣做的真正美妙之處在于,因為它是用 C 實現的,可維護性高,可以快速構建一個我們需要的PID算法。
總結
雖然上面的流程很簡單,但是HLS在調整資源和速度方面還是需要一些時間,并且浪費的資源還是比純HDL多。
最后在說一下該方式的缺點,PID需要進行浮點運算,而FPGA則不能進行浮點運算,如果想把上面的算法在邏輯中運行,則需要自己進行量化,但是如果像上面例程的方式在內核(硬核)中運行算法,則該方式簡單且優雅~
審核編輯:彭靜
-
控制器
+關注
關注
114文章
16963瀏覽量
182893 -
PID算法
+關注
關注
2文章
172瀏覽量
24788 -
HLS
+關注
關注
1文章
131瀏覽量
24641
原文標題:在 FPGA 上快速構建 PID 算法
文章出處:【微信號:Open_FPGA,微信公眾號:OpenFPGA】歡迎添加關注!文章轉載請注明出處。
發布評論請先 登錄
總結STM32控制中常見的PID算法 理解萬能的PID算法
PID算法的問題
新手求助,HLS實現opencv算法加速的IP在vivado的使用
PID算法有哪些應用
PID算法之模糊PID 精選資料推薦
數字PID控制算法教程之如何對標準PID算法進行改進

如何在FPGA上快速構建PID算法

評論