【文章內容簡介】 Vn。由Vn和△Tn相乘就可以計算出時間差△Tn中所包含的高精度動態(tài)位置信息，因此當前有效采樣周期內的增量式高精度動態(tài)位置信息可以由式(7)所示的高精度動態(tài)位置檢測算法得出：其中vn1和△Tn1為上一有效采樣周期的測量結果，且v0=0和△T0= 0。高精度動態(tài)位置檢測算法得到的位置信息Pn由整數和分數vn△Tnvn1Tn1 兩部分組成，其中分數部分vn△Tn。可進一步整理為可見高頻時標脈沖頻率f0確定時vn△Tn只受vn和的影響。式中：vn是被測對象的速度， 是當前有效采樣周期的定周期采樣點和實際采樣點之間高頻時標脈沖的計數差，其最小有效值等于1。因此，vn△Tn所表達的動態(tài)位置信息的分辨率可以表示為:其中fPn是與被測對象速度相對應的反饋脈沖頻率。由此可見，高精度動態(tài)位置檢測算法的測量分辨率與高頻時標脈沖的頻率成反比，與被測對象的速度成正比，即：低速段分辨率較高，而高速段分辨率較低。因此，高精度動態(tài)位置檢測算法可以利用高頻時標信號f0的內插作用，從具有動態(tài)連續(xù)測量能力的增量式光柵編碼器的反饋脈沖信號中獲取比單位脈沖當量更加精細的動態(tài)位置信息，避免了傳統方法因簡單累計反饋脈沖的個數所造成的截尾效應，提高了位置反饋的動態(tài)測量分辨率?？傊?，高精度動態(tài)位置檢測算法可以提高增量式光柵編碼器位置反饋的動態(tài)測量分辨率，使伺服控制的位置環(huán)獲得更加精細的反饋輸入，降低調節(jié)輸出的波動，提高位置伺服的控制性能。 主要擬討論如何在單位時間內可準確發(fā)送脈沖個數，而且發(fā)送的脈沖個數可調。 ALTERA FPGA介紹FPGA（Field－Programmable Gate Array），即現場可編程門陣列，它是在PAL、GAL、CPLD等可編程器件的基礎上進一步發(fā)展的產物。它是作為專用集成電路（ASIC）領域中的一種半定制電路而出現的，既解決了定制電路的不足，又克服了原有可編程器件門電路數有限的缺點。Altera 的主流FPGA分為兩大類，一種側重低成本應用，容量中等，性能可以滿足一般的邏輯設計要求，如Cyclone，CycloneII；還有一種側重于高性能應用，容量大，性能能滿足各類高端應用，如Startix，StratixII等，用戶可以根據自己實際應用要求進行選擇。在性能可以滿足的情況下，優(yōu)先選擇低成本器件?！　”敬卧O計暫時使用Cyclone系列，進行實驗驗證。 FPGA硬件 電源接入amp。濾波amp。晶振部分 內存及FLASH JTAG下載 端口擴展部分 HDL編程語言介紹 Verilog HDL是目前應用最為廣泛的硬件描述語言．Verilog HDL可以用來進行各種層次的邏輯設計，也可以進行數字系統的邏輯綜合，仿真驗證和時序分析等?！　erilog HDL適合算法級，寄存器級，邏輯級，門級和版圖級等各個層次的設計和描述．　　Verilog HDL進行設計最大的優(yōu)點是其工藝無關性．這使得工程師在功能設計，邏輯驗證階段可以不必過多考慮門級及工藝實現的具體細節(jié)，只需根據系統設計的要求施加不同的約束條件，即可設計出實際電路．EAx in x軸編碼器A相輸入 EBx in x軸編碼器B相輸入 EZx in x軸編碼器索引輸入 OUTx out x軸輸出控制電機的指令脈沖 DIRx out x軸輸出控制電機轉動方向的信號ELLx in 指定+EL信號輸入邏輯 in+ELx in x軸正方向限位信號 ELx in x軸負方向限位信號 SDx in x軸限位減速信號 ORGx in x軸原點輸入信號ALMx in x軸報警輸入，當有效時，立即停機，或減速停機。PCSx in x軸重新設定目標位置信號，當有效時，重新設定目標位置ERCx in 偏差計數器清零信號 INPx in x軸到位信號 CLRx in 復位4個計數器中指定寄存器的信號 LTCx in 鎖存4個計數器中指定寄存器的信號 BSYx in 判斷X軸是否在運動的信號 ：普通寄存器：RMV R\W 運動距離、目標位置RFL R\W 初始速度RFH R\W 運動速度RUR R\W 加速度RDR R\W 減速度RDP R\W 減速點RMD R\W S曲線加速區(qū)段RUS R\W S曲線減速區(qū)段RCUN1 R\W COUNTER1 指令位置計數器RCUN2 R\W COUNTER2 機械位置計數器RCUN3 R\W COUNTER3偏差計數器RCUN4 R\W COUNTER4 通用計數器RCMP1 R\W 比較器1數據RCMP2 R\W 比較器2數據RCMP3 R\W 比較器3數據RCMP4 R\W 比較器4數據RCMP5 R\W 比較器5數據RIRQ R\W INT設置RLTC1 R COUNTER1鎖存數據RLTC2 R COUNTER2鎖存數據RLTC3 R COUNTER3鎖存數據RLTC4 R COUNTER4鎖存數據RPLS R 定位計數器RSPD R EZ計數器、速度監(jiān)控器RSDC R 自動計算減速點預置寄存器PRMV R\W 運動距離、目標位置PRFL R\W 初始速度PRFH R\W 運動速度PRUR R\W 加速度PRDR R\W 減速度PRDP R\W 減速點PRMD R\W S曲線加速區(qū)段PRUS R\W S曲線減速區(qū)段：：a. 編碼器接口電路主要實現脈沖的精確測量，與方向測量，從而實現機器位置計數器，偏差計數器，通用計數器，定位控制計數器對EAx,EBx的精確計數。b. 指令位置計數器對加減速脈沖控制電路的輸出脈沖進行測量，把數傳遞給寄存器控制電路，以用來告知執(zhí)行指令的狀態(tài)。c. 機器位置計數器對編碼器接口電路的輸入脈沖進行測量，用以測量機械位置。d. 偏差計數器監(jiān)視指令位置與當前機械位置之間的偏差，通過寄存器控制電路，對加減速脈沖控制電路進行速度或位置補償。e. 定位控制計數器對加減速脈沖控制電路的輸出進行監(jiān)視測量，和RMV寄存器比較，已判斷是否到達目標位置。f. 比較器把計數器里的值與比較器里裝載的值相比較，來判斷此事此刻的運動狀態(tài)，再把信息反饋給寄存器控制電路g. 加減速控制電路通過裝載速度信息，從而發(fā)出脈沖驅動預置功能實現框圖：4 仿真實驗結果—5tclk=clk—80tclk=clk —5000tclk=clk—10000tclk=clk 5 應用案例基于FPGA+MCU的伺服電機控制器： GUC400TPV/TPGM0XL2 是固高科技GUC 系列運動控制器的成員之一，是嵌入式PC 與運動控制器結合為一體的產品，與“工業(yè)計算機+運動控制器”結構的運動控制系統相比，具有更高的可靠性、穩(wěn)定性、抗干擾能力和更好的性價比。該產品具有優(yōu)越的運動控制功能和性能,豐富的運動控制功能等特別適用于高速、高精度精確位置控制要求的場合,強大的同步控制功能更是滿足許多行業(yè)的同步控制功能需求。如，PCB 加工，半導體封裝，印染，包裝，剪切，服裝加工等行業(yè)。該運動控制器還提供高速IO 現場總線擴展接口，可進行IO 的擴展，能滿足多IO 點控制的要求。用戶可選用固高科技現場網絡IO 擴展模塊及人機界面(HMI)，獲得一站式控制系統解決方案。5．2雷賽SMC6480SMC6480控制器是雷泰公司自主研發(fā)的基于10/100M以太網的通用型獨立式運動控制器，可支持多個控制器和PC組成控制網絡，網絡中控制器的數量沒有限制；也可應用于各種需要脫機運行的場合。 本控制器可控制4個步進或伺服電機，具有最高5MHz脈沖頻率、四軸直線插補、兩軸圓弧插補、連續(xù)曲線插補、S形曲線速度控制等高級功能。 SMC6480基于嵌入式處理器和FPGA的硬件結構，插補算法、脈沖方向信號的輸出、自動升降速的處理、原點及限位等信號的檢測處理，均由硬件實現，確保了高性能運動控制的高速、高精度及系統的穩(wěn)定。通過簡單的編程設定即可開發(fā)出穩(wěn)定可靠的高性能高速連續(xù)軌跡運動控制系統。 SMC6480系統結構框圖如11所示。除了4個電機控制端口外，還提供了豐富的I/O接口和通訊接口：雙路高精度DA輸出，雙路PWM控制輸出，16路隔離輸入口，8路隔離輸出口，其中有兩路電流增強輸出，并可通過擴展接口擴展更多的IO接口；一個10/100M網絡接口、兩個RS232，可通過網絡或RS232直接與PC機通信；同時還可以通過RS232連接其它設備，如：文本屏、觸摸屏，作為輸入輸出界面。 6 結論 通過本次畢業(yè)設計，了解并理解了整個伺服平臺研發(fā)項目每個功能模塊的意義，也學習到了很多和伺服電機控制相關的知識，在FPGA模塊設計中，提出了一種合理的設計思路，定義了輸入輸出端口，寄存器，并成功的將主要算法進行了驗證。完成繪制了FPGA硬件原理圖，高速光耦輸入輸出原理圖，相信對下一研發(fā)項目基于FPGA的運動控制