引 言
本文引用地址:http://www.eepw.com.cn/article/275082.htm電動機是各類數控工具機的重要執行部件。要實現對電動機的精確位置控制,轉子的位置必須能夠被精確的檢測出來。光電編碼器是目前最常用的檢測器件。光電編碼器分為增量式、絕對式和混合式。其中,增量式以其構造簡單,機械壽命長,易實現高解析度等優點,已被廣泛採用。增量式光電編碼器輸出有A,B,Z三相信號,其中A相和B相相位相差90°,Z相是編碼器的「零位」,每轉只輸出一個脈衝。在應用中,經常需要對A相、B相正交脈衝按照一定的比例,即分周比進行分頻。分頻的難點是,無論設定分周比是整數還是分數,分頻後輸出的A'相,B'相脈衝仍然要保持正交或近似正交。為此提出一種基於FPGA的整數分周比實現方法。該方法邏輯結構簡單,配置靈活,易於擴展,具有很高的實用價值。
1 電子齒輪比與分周比
電子齒輪比與分周比是數控工具機和數控加工中心中一個很重要的概念。國外大部分伺服驅動裝置有電子齒輪比和分周比功能,其中電子齒輪比KEG為伺服電機實際執行的脈衝量與指令脈衝量之比,分周比KDF是伺服驅動器接收到來自伺服電動機軸上脈衝編碼器的脈衝量與實際反饋到上位伺服控制系統(CNC)上脈衝量的比。配合使用電子齒輪比和分周比功能,用戶可以方便地實現整數脈衝當量,從而避免中間計算出現量化誤差,在不修改G代碼的情況下,將代碼直接移植到配備不同電機編碼器線數或者不同螺距絲槓的工具機或者加工中心。
電子齒輪比和分周比可以按照下式計算求得。
式中:PG為電機光電編碼器線數,單位為P/rev(脈衝/轉);P為絲槓螺距,單位為mm/rev(毫米/周);△l為脈衝當量,單位為mm/P(毫米/脈衝);m/n為減速比。
電子齒輪比可以利用脈衝頻率的變換實現,而對於分周比,由於驅動器反饋到CNC的脈衝量一般採用正交脈衝序列,故分周比的實現相對於齒輪比要困難。國外的各種驅動器一般都帶有分周比功能,對利用FPGA實現分周比進行研究和探討,電子齒輪比、分周比功能示意圖如圖1所示。
2 分周比的原理框圖
分周比功能的實現結構如圖2所示。
分周比的實現需要3個功能模塊:四倍頻模塊QD-PF、分頻模塊DF、正交序列生成模塊OSG。QDPF模塊的輸入為正交脈衝序列,輸出為方向信號和四倍頻後的脈衝。DF模塊可實現輸入脈衝的三分頻。DF內部是一個增減計數器,根據輸入的方向信號進行增、減計數,正向計至設定的正閾值後輸出一個脈衝和正方向信號,負向計至設定的負閾值後輸出一個脈衝和負方向信號。當計數值在正負閾值之間時,即使電機方向發生變化,甚至抖動,輸出方向信號都保持不變。
OSG模塊用輸入脈衝沿觸發內部狀態機進行狀態轉換,根據輸入的方向信號判決要跳轉的狀態,從而產生正交信號和方向信號。
3 仿真研究
根據圖2,利用ACTEL公司的Libro 8.1開發平臺,採用VHDL硬體語言,創建了相應的功能模塊,原理圖如圖3所示。
圖3中,PA205,PB206分別是原始差分信號的A相、B相的輸入引腳。信號經QDPF四倍頻後將方向信號和脈衝信號輸出給DF分頻模塊。經DF分頻後將脈衝、方向信號輸出給正交脈衝生成模塊OSG,產生帶相位的正交信號,最後從PA119,PB120反饋到CNC。下面對主要模塊做分別介紹。
四倍頻模塊QDPF:正交信號的四倍頻方法有很多種,在很多資料中都涉及,在此不做詳細介紹。
分頻模塊DF按照初始化配置的分周比或者預先設定的分周比,對輸入CLK_IN引腳的脈衝序列分頻。內部的增、減計數器根據輸入DIR_IN引腳的方向信號對輸入脈衝進行增(DIR_IN=1)或減(DIR_IN=0)計數,增計數至正閾值時輸出一個脈衝和正方向信號(DIR_OUT=1),減計數至負閾值是輸出一個脈衝和負方向信號(DIR_OUT=0)。若計數值在正、負閾值之間時,不論電機反向,還是在閾值見抖動,即方向反覆變化,輸出方向信號都保持不變。這是能正確實現分頻的關鍵,如果這一步處理不好,電機定位後可能會出現不斷向CNC發脈衝的情況。以三分頻為例,即計數器增計數至3後輸出一個正脈衝(正方向信號+脈衝),計數器減計數至-3後輸出一個負脈衝(負方向信號+脈衝)。計數值在(-3,3)時,計數器只對脈衝計數而不輸出。對QDPF 的仿真結果如圖4所示。
OSG被脈衝信號的上升沿觸發後,根據當前狀態和方向信號,跳到下一個狀態。當方向信號為正時,按照外環的逆時針方向切換狀態,產生A'相超前B'相 90°的正交脈衝序列;當方向信號為負時,按照內環的順時針方向切換狀態,產生B'相超前A'相90°的正交脈衝序列,仿真如6所示。
圖6中,dir為方向信號,其跳變沿即方向變化處。由圖6可見,電機正轉時順序為10→11→01→00(反向)→01→11→10→…。實現了相位隨輸入信號的切換。
最後,對分周比功能整體結構進行仿真,輸入為正交的脈衝序列。輸入模仿實際電機光電編碼器脈衝輸出對脈衝相位反覆切換以驗證電機定位後的輸出。仿真如圖7所示。
從圖7中可見,當輸入信號pula,pulb相位不斷切換時,輸出pula1,pulb1按照3分頻,滿足3或-3後輸出新的正交序列。實際實驗波形如圖8所示。
圖8中,波形1、波形2分別是光電編碼器輸出的A相、B相正交脈衝。波形3、波形4分別是對A相、B相正交脈衝3分頻後的A'相、B'相正交脈衝。觀察圖 7,圖8,結果一致。用此方案實現的分周比已經成功應用於高精度伺服驅動器中,在實際應用中反覆驗證,未發現誤差。
4 結 語
本文提出的分周比實現方法可以準確地將光電編碼器輸出的正交信號按照設定的分周比進行分頻。通過設定分頻比可以實現1~256倍的分頻,甚至更高。在實際系統中,還可以利用MCU通過總線在線配置分周比。假如要實現分數比例的分周比,也只需在本方案基礎上稍加改進即可。
fpga相關文章:fpga是什麼
伺服電機相關文章:伺服電機工作原理
脈衝點火器相關文章:脈衝點火器原理