一種基于FPGA的三軸伺服控制器的設計優(yōu)化
目前伺服控制器的設計多以DSP或MCU為控制核心,但DSP的靈活性不如FPGA,且在某些環(huán)境比較惡劣的條件如高溫高壓下DSP的應用效果會大打折扣,因此以FPGA為控制核心,對應用于機載三軸伺服控制平臺的控制器進行了設計與優(yōu)化。
1 總體方案
FPGA(Field-Prograromable Gate Array,現(xiàn)場可編程門陣列)是在PAL,GAL,CPLD等可編程器件的基礎上進一步發(fā)展的產物。FPGA采用了邏輯單元陣列LCA(Logic Cell Array)這樣一個概念,內部包括可配置邏輯模塊CLB(Configurable Logic Block)、輸出輸入模塊IOB(Input Output Block)和內部連線(Interconnect)三個部分。可以說,F(xiàn)PGA芯片是小批量系統(tǒng)提高系統(tǒng)集成度、可靠性的最佳選擇之一,因此在設計中采用FPGA為控制核心。FPGA的基本特點主要有:采用FPGA設計ASIC電路,用戶不需要投片生產,就能得到可用的芯片;FPGA可做其他全定制或半定制ASIC電路的中試樣片;FPGA內部有豐富的觸發(fā)器和I/O引腳;FPGA是ASIC電路中設計周期最短、開發(fā)費用最低、風險最小的器件之一;FPGA采用高速CHMOS工藝,功耗低,可以與CMOS、TTL電平兼容。
整個控制器由控制和驅動兩部分組成,其結構如圖1所示??刂撇糠钟蒄PGA及一些附件組成,該控制器能夠獨立完成三軸控制器的電機驅動波形發(fā)生、閉環(huán)運算與控制、與上位機通信等任務,附件主要用來完成電樞電流的反饋等功能。驅動模塊由光電耦合器件和放大驅動芯片等組成。該控制器的最終控制目標為對驅動三軸的力矩電機進行高精度定位與驅動。力矩電機的位置和速度反饋由光電編碼器實現(xiàn)。
由于本控制器所應用的機載平臺為三軸結構,因此,控制器采用獨立式控制,即每個軸都具有圖1所示的控制功能,三個相對獨立的分控制器組成整體的三軸控制器。該基于FPGA的三軸伺服控制器的基本控制方案就是這種反饋式的高精度控制,其中速度環(huán)使用PD控制算法,位置環(huán)使用PID控制算法。調整PID參數(shù),通過控制電壓來控制跟蹤瞄準精度,使得跟蹤瞄準精度逐漸提高,達到所需盼精度要求。
2 控制器硬件與軟件的設計與實現(xiàn)
本伺服控制器以FPGA為核心,在硬件設計中主要進行了驅動模塊設計、控制模塊設計和通信模塊設計。驅動模塊能夠根據外部給定的驅動角度產生驅動信號,控制模塊則能夠對光電編碼器測得的角度信號和速度信號進行分析、反饋及運算,最終給出PWM脈寬值驅動整個系統(tǒng),在這期間還需要功放的放大作用,而通信模塊的主要功能是實現(xiàn)與上位機的有效通信,并能夠實現(xiàn)控制器的在線編程功能和上位機對三軸系統(tǒng)中力矩電機的遠程控制功能。
驅動模塊主要包括控制波產生單元、力矩電機光電編碼器信號采集與處理、可編程死區(qū)發(fā)生器等部件。驅動模塊中的信號功率放大部分和隔離措施的應用也是該部分中的重要設計內容,在此設計中功率放大采用普通的晶體管放大電路,而光電隔離器件的應用能夠有效防止強電模塊對弱電部分的影響。在驅動模塊中輔助芯片采用可編程器件EPlK30QC208,它采用可重構的CMOS SRAM工藝,把連續(xù)的快速通道與獨特的嵌入式陣列(EAB)相結合,同時結合眾多可編程器件的優(yōu)點來完成普通門陣列的宏功能,主要完成伺服控制器的各種硬件邏輯接口功能。 EPlK30QC208主要完成4個接口的邏輯功能,即:主機接口、D/A接口、碼盤接口、I/O接口。D/A轉換器件采用雙通道DAC芯片DAC5573,相對TLC2543來說,硬件的連接簡單很多,因為它采用標準的I2C總線,同時S3C4510里包含I2C的控制器,所以DAC5573只需接到4510的SDA和SCL這兩個引腳,就可以實現(xiàn)兩者之間的通信。需要注意的是,SDA和SCL這兩個引腳需要上拉電阻值為10 kΩ的電阻來確保I2C總線能夠釋放出來。 控制模塊方面速度環(huán)節(jié)和位置環(huán)節(jié)分別采用PD和PID控制。因此在控制器設計中需要在這方面有所體現(xiàn)。由于本控制器以控制直流力矩電機為最終目的,因此在控制模塊的設計方面需要研究力矩電機的驅動及其電壓值獲取。在本控制器設計過程中需要對上述各項進行綜合控制與處理,以達到合理地控制開銷和控制精度的平衡。在三軸伺服裝置中選用PID控制算法。引入通常的PID控制算法,并考慮功率放大、位置檢測環(huán)的增益和速度環(huán)的PD控制算法,給定三軸電樞電壓。
pid控制器相關文章:pid控制器原理
評論