飛鋸控制系統鋸車位置和速度的測量方法

甄自源， 楊振強

(大連理工大學 電氣工程學院，遼寧 大連 116023)

?

飛鋸控制系統鋸車位置和速度的測量方法

甄自源， 楊振強

(大連理工大學 電氣工程學院，遼寧 大連 116023)

飛鋸控制系統作為一種高精度管材切割系統，其精度和穩定性很大程度上取決于鋸車位置和速度的測量精度和穩定性。基于以上需求，使用TMS320F28069處理增量式光電編碼器發出的脈沖信號，提出了一種測量該系統鋸車位置與速度的方法。該方法引入脈沖長度簡化運算和操作，提高了更換設備時的效率，同時給出了鋸車行進長度的計算公式。在測量鋸車速度方面，優化M/T加權平均過渡法以保證測速能夠平滑過渡，并通過誤差分析和仿真驗證了此方法的可行性，滿足了系統對精度和穩定性的要求。

飛鋸控制系統；脈沖長度；M/T加權平均過渡法

0 引言

飛鋸控制系統可廣泛用于管材、型材等生產線的高精度連續自動追蹤切割，大幅提高生產效率。由于系統為動態在線切割，對位置與速度的精度要求較高[1]，因此能夠準確測量鋸車的位置和轉速顯得至關重要。該系統以DSP作為運動控制器，其中的eQEP(增強正交編碼脈沖)模塊能夠高速采集光電編碼器的脈沖信號，再對其進行處理和計算即可測量鋸車的位置和轉速，精確度與PLC控制相比大為提高。同時在計算轉速時使用更加合理的算法，可以使高轉速和低轉速之間能夠平滑過渡，進一步提高系統的穩定性。

1 飛鋸控制系統概述

1.1 飛鋸控制系統的組成

本文所述飛鋸控制系統由以TMS320F28069處理器為核心的運動控制器、VFD-VE伺服型變頻器、DOP-B05S100 觸摸屏、鋸車系統以及測速系統等組成，如圖1所示。

圖1 飛鋸控制系統組成框圖

運動控制器對整個系統進行監視和控制。伺服型變頻器接收運動控制器發出的電壓信號轉化為頻率來調整鋸車電機的轉速。觸摸屏可發出不同的動作指令，調整系統的部分參數，并顯示系統的運行狀態。鋸車系統由可前后移動的鋸車與固定軌道組成，鋸車上裝有鋸片，并連接繼電系統[2]，其機械結構示意圖如圖2所示[3-4]。繼電系統用來下達夾緊、松夾、落鋸、抬鋸等動作指令。測速系統可實時測量各電機的轉速，其中編碼器選用的規格是24V，1000線的增量式光電編碼器。

圖2 鋸車系統機械結構示意圖

1.2 飛鋸控制系統鋸車的運動狀態分析

在本系統中，需要測量以下四部分組件的速度：鋸車行進速度、管行進速度、鋸片轉速和鋸片主軸移動速度。鋸車和管材的各階段運動狀態圖如圖3所示，其中T1為鋸車加速階段，T2為夾緊前鋸車調整階段，T3、T4、T5、T6分別為夾緊、落鋸、抬鋸、松夾階段，T7為鋸車回零點階段，T8為鋸車零點調整階段[5]。

圖3 鋸車各階段運動狀態

理想狀態下，管材勻速前進，鋸車與管行進至兩者行程差為設定的切割管長時，兩者恰好同速，輸出夾緊管材的信號再落鋸切管；然而由于實際上管材并不總是勻速前進，且測量有誤差，此時鋸車與管可能不同速，但速度差最好盡量小。由此可見，鋸車行進位置和速度的測量精度及穩定性尤為重要。

本系統管長設定范圍為2m～6m，定尺精度為3mm，即切割后的管材與設定管材的誤差最大值為±3mm。具體到各運動階段來說，發送夾緊管材信號前定尺精度主要取決于管材與鋸車相對位置的測量精度；在發送夾緊管材信號后至管材被夾緊(由于繼電器有動作時間)時，定尺精度主要取決于管材與鋸車相對速度的測量精度，此部分定尺精度系統要求為1mm。本文以鋸車為例，提出其位置和速度的測量方法，又由于管材以勻速行進，則定尺精度以及系統穩定性主要取決于鋸車位置和速度的精度和穩定性。

2 eQEP(增強正交編碼脈沖)模塊

TMS320F28069處理器的eQEP模塊結合增量式光電編碼器可實現獲取運動控制系統位置、速度以及方向信息的功能[6]。

eQEP模塊的QEPA和QEPB引腳為正交時鐘模式輸入引腳，可接收編碼器輸出的相差90°的方波信號。如圖4所示，這一系列正交脈沖信號經由正交解碼單元QDU解碼后得到4倍頻的位置脈沖信號和方向信號，再通過位置計數器進行脈沖計數得到QPOSCNT和QDIR的值，即為電機的位置信息和方向信息[7]。

圖4 eQEP輸入信號計數與方向解碼

3 行進長度的測量

3.1 編碼器位置變化的脈沖計數測量

本文主要關注的是鋸車的行進長度。通過將光電編碼器與電機相連，根據1.1節和1.2節所述就可對鋸車位置進行測量，由于行進長度是和編碼器的累積行程相關，而不用關注編碼器的旋轉周數，因此只需記錄eQEP位置鎖存器QPOSSLAT的值來確定編碼器向前或向后行進了多少個QCLK脈沖。

3.2 脈沖長度的應用

若要計算鋸車行進長度，除了記錄編碼器產生的脈沖計數值，還需要引入一個系數——脈沖長度，即編碼器的一個脈沖可換算為多少長度。由于鋸車系統結構不同，因此鋸車脈沖長度Kc的計算方法也不同，如式(1)所示：

(1)

其中，Z為齒輪齒數，M為齒輪模數，X為編碼器計數的倍頻，P為編碼器的每轉脈沖數，I為減速箱傳動比。本系統使用的76型飛鋸齒數Z為25，模數M為8，鋸車履帶傳動比I為7.1，鋸車編碼器為1000/rpm，4倍頻，則代入上面公式計算得鋸車脈沖長度Kc=0.0221mm。

由于鋸車脈沖長度Kc均可通過觸摸屏輸入來隨時更改，因此當系統的部分設備更換或有一定的磨損后，只需更改這個脈沖長度即可滿足設備變化的要求，簡化了計算和操作。

3.3 行進長度的計算

根據3.1和3.2節，可得到行進長度的計算公式，如式(2)所示：

L=CNT×K

(2)

其中，L為行進長度(前進方向為正)，CNT為eQEP位置鎖存器QPOSSLAT的值，K為脈沖系數。式(2)也可應用在其他組件計算行進長度的情況。

由于每次測量行進長度時，脈沖計數值有±1個脈沖的最大誤差，因此本方法在測量行進長度時的誤差為1個脈沖對應的長度，即脈沖長度。同時為了避免系統長時間運行導致誤差累積，鋸車在完成一定次數切管后，返回起始位置時應對起始位置，即行進長度為0的點進行校正[8]。校正后的起始位置由限位開關確定。

4 鋸車速度的測量

4.1 M/T加權平均過渡法測速的原理

M法和T法是電機轉速測量的常用方法。其中，M法是指通過測量在一定時間間隔T1內編碼器產生的脈沖數M1來計算轉速的方法[9]。又由于本系統引入了脈沖長度，可將測量轉速轉化為測量脈沖頻率f1(每秒產生的脈沖數)，故可得式(3)：

(3)

若使用DSP的eQEP模塊進行M法測速，則需使能eQEP的UTO(單位超時)中斷，通過設置單位周期寄存器QUPRD的值N1和系統時鐘頻率f0來確定T1，通過測量前后兩次進中斷時的位置計數鎖存器QPOSLAT的差來確定M1。故式(3)可化為式(4)：

(4)

在某些極端情況下M1會有±1的誤差，則在測量較高轉速時M1的相對誤差較小，而T1又為定值，因此M法在測量高速時誤差較小[10]。

而T法是指通過測量編碼器產生一定數量的脈沖M2所需要的時間T2來計算轉速的方法。同M法，脈沖頻率f2的計算公式如式(5)[9]：

(5)

若使用DSP的eQEP模塊進行T法測速，則需檢測eQEP的狀態寄存器QEPSTS的單位位置時間標志位UPEVNT，通過設置捕捉控制寄存器QCAPCTL和單位位置事件預定標UPPS來確定M2，而T2通過對分頻后的系統時鐘脈沖進行計數的計數值N2來確定，其中時鐘頻率由系統時鐘頻率f0和捕捉定時器時鐘預定標CCPS來確定，計數值由捕捉周期鎖存器QCPRDLAT來確定。則式(5)可化為式(6)：

(6)

需要注意的是，eQEP的捕捉定時器發生上溢會導致鎖存器QCPRDLAT的偏差較大，因此需要監測狀態寄存器QEPSTS捕捉上溢標志位COEF，當該標志位為“1”時T2的值不能用于計算轉速。

在某些極端情況下T2會有±1的誤差，則在測量較低轉速時T2的相對誤差較小，而M2又為定值，因此T法在測量低速時誤差較小[11]。

M法和T法分別適用于測量高速和低速的情況，若將轉速以某一個值作為分界線來區分高速與低速，可能會出現M法和T法相互轉換時轉速突變的情況。根據這一情況，可采用M/T加權平均過渡法來進行測速，即在高速和低速時分別使用M法和T法測速，在測速誤差接近需要切換時使用變系數加權平均法，使轉速平滑切換，測量誤差無波動，以提高系統的穩定性[12]。

M/T加權平均過渡法將電機轉速分為三個區域，即高速區、低速區和過渡區，計算公式如式(7)所示：

f=sf1+(1-s)f2

(7)

其中，f為加權計算后的脈沖頻率，與鋸車脈沖長度相乘即為鋸車行進速度，故后文均將f的誤差率作為鋸車速度的誤差率；f1為M法測量的轉速，s為其權值；f2為T法測量的轉速，1-s為其權值。

s的計算方法有多種，文獻[12]曾給出一種線性算法。基于該方法，可應用于飛鋸控制系統的s的計算公式如式(8)所示：

(8)

其中，fa是f1與f2的平均值，作為該時刻轉速處在何區域的判斷頻率值，即fa=(f1+f2)/2；fH是高速區與過渡區的分界限轉速值；fL是低速區與過渡區的分界限轉速值。

該方法有一定的合理性，且計算簡單，但還可以進一步優化，具體分析將在4.2節論述。

4.2 誤差分析與仿真

由1.2節可知，在發送夾緊管材信號后至管材被夾緊時，定尺精度系統要求為1mm，定尺精度以及系統穩定性主要取決于鋸車位置和速度的精度和穩定性。設ΔL為鋸車行進長度測量誤差最大值，δmax為測速誤差率最大值，fmax為脈沖頻率最大值，ΔT為夾緊繼電器最大動作時間，則其計算公式如式(9)所示：

ΔL=δmaxfmaxKcΔT

(9)

其中，fmax為200kHz，ΔT為25ms。由3.2節Kc=0.0221可計算得，δmax=0.9%。故測速誤差率不能超過0.9%。

為了使過渡區的轉速平滑切換，測速誤差不大于0.9%，則需保證過渡區的轉速誤差率函數連續，且函數值不大于0.9%。M法和T法的測速誤差率分別如式(10)和式(11)所示[13]：

(10)

(11)

而過渡區的測速誤差率如式(12)所示：

(12)

由于M法和T法的測速誤差率函數都是單調的，因此同一轉速下測速誤差率也相同時的脈沖頻率為測速誤差分界點，即脈沖頻率大于此頻率時M法測速誤差較小，而小于此頻率時T法測速誤差較小，故這個測速誤差分界點應該在過渡區內。由式(13)即可算出該脈沖頻率：

(13)

在本文的飛鋸控制系統中，相關參數設置如下：f0=8MHz，N1=16000，UPPS=5，CCPS=4，計算可得測速誤差分界點時的脈沖頻率為89.2kHz。選取fH=100kHz，fL=80kHz，此時，若使用式(8)的線性算法s的取值計算公式如式(14)所示，相應函數圖形如圖5所示。

(14)

圖5 權值線性算法函數圖

高速區(M法)的誤差率在脈沖頻率為100kHz時為最大值0.5%，低速區(T法)的誤差率在脈沖頻率為80kHz時為最大值0.503%，而在過渡區，令fa=f，將式(14)代入式(12)可算出在該區域內以脈沖頻率f(單位為kHz)為自變量的線性算法誤差率函數如式(15)所示：

(15)

該函數的Matlab仿真圖如圖7虛線所示，該函數在(80,100)的區間內連續，且最大值約為0.56%。而本文提出M/T加權平均過渡法權值的另一種算法，s隨fa以二次函數規律變化，簡稱為二次算法。該函數如式(16)所示，相應函數圖如圖6所示。

(16)

該方法在高速區和低速區的誤差率與線性算法相同。令fa=f，將式(14)代入式(12)可得過渡區內以脈沖頻率f為自變量的二次算法誤差率函數，如式(17)所示：

(17)

二次算法的誤差率函數仿真圖如圖6實線所示，圖中脈沖頻率處于(80,100)的區間為過渡區，

圖6 權值二次算法函數圖

其他區域分別對應低速區和高速區，即分別應用了T法和M法。由該圖易知，該函數在過渡區內時連續，且最大值與一次算法的最大值相同。兩種算法的結果最大的不同是，在除邊界值和最大值處之外，二次算法的轉速誤差率均比線性算法的誤差率低，并且在分界點80kHz和100kHz處，二次算法函數斜率與其他區域斜率連續，即轉速誤差率變化更加穩定，因此二次算法更加合理。

圖7 過渡區內誤差率仿真圖

選用二次算法的M/T加權平均過渡法測速誤差率如表1所示。由表1可知，本方法測速誤差率最大值不超過0.6%，滿足誤差率連續且不大于0.9%的要求。

表1 M/T加權平均過渡法的頻率分區和誤差率表

5 結論

本文介紹了飛鋸控制系統，以及測量其鋸車位置和轉速的精度和穩定度的重要性。同時介紹了DSP的eQEP(增強正交編碼脈沖)模塊測量該系統鋸車行進長度和轉速的的方法和計算公式。其中，引入脈沖長度可優化行進長度和轉速的算法，簡化設備更換或磨損后的操作，提高了效率；使用M/T加權平均過渡法來測速保證了高轉速與低轉速能平滑轉換，且誤差率不大于0.9%，同時對權值的計算方法進行了優化，使用更加合理的二次算法，進一步保證了系統的精度和穩定性。

[1] 王海鵬,陳和平,朱英韜,等. 工業機器人在板材切割生產線的應用[J]. 組合機床與自動化加工技術, 2015(5):141-144.

[2] 李平，楊曉明，牛驍. 飛鋸機的控制方案簡析[J]. 重型機械科技，2006(2):36-39.

[3] 于冬,顧培亮,高璇. 基于PLC技術的自動切管機控制系統的研究[J]. 組合機床與自動化加工技術, 2004(10):7-9.

[4] 任意，石小英，曾勝.全自動型材切割機設計與實現[J].電機與控制應用，2009(9)：30-33.

[5] Yuhua Zhang, Xinhuan Song.The Motion Control of Profile Milling Flying Saw[C] // MATEC Web of Conferences 2015. 2015 7th International Conference on Mechanical and Electronics Engineering, 2015, 31：03014p1- 4.

[6] Texas instruments. TMS320x2806x Piccolo Technical Reference Manual[S]. 2011，1：452-453.

[7] 王子博. 編碼器四倍頻電路的單片機高速算法設計[J]. 組合機床與自動化加工技術, 2007(11):73-74,78.

[8] 楊紅波. 銅材自動定尺飛鋸機控制系統的研究[D].大連:大連交通大學, 2010.

[9] 鄧建，林樺. 基于DSP的絕對式光電編碼器的電機轉速測量[J].電機與控制應用，2010(1)：50-52,55.

[10] 蘇指南. 仿形銑切飛鋸的運動控制[D].天津:天津理工大學, 2011.

[11] 李昕奇，金勇. 基于DSP2812的電動機測速方法的研究[J]. 電氣自動化，2011(4)：81-82.

[12] 張濤，楊振強，王曉旭. 應用eQEP及編碼器測量電機位置與速度的方法[J]. 電氣傳動，2011(4)：48-51.

[13] 陳伯時. 電力拖動自動控制系統-運動控制系統[M]. 3版.北京:機械工業出版社，2006.

(編輯 李秀敏)

Method of Measuring Saw Car’s Position and Speed in Flying Saw Control System

ZHEN Zi-yuan,YANG Zhen-qiang

(College of Electrical Engineering, Dalian University of Technology, Dalian Liaoning 116023, China)

As a high precision pipe cutting system, accuracy and stability of flying saw control system depends largely on the accuracy and stability of the saw car’s position and speed. Based on the above requirements，introduced a method applied to this system to measure the saw car’s position and speed, which utilizes TMS320F28069 to process the pulse signals transmitted from incremental optical encoder. The method introduces pulse length to simplify the calculation and operation, which improves efficiency of changing instruments. The computational formula of moving length of the saw car is given. The method of M/T weighted average transition is optimized to guarantee smooth transition of measuring rotate speed, of which the practicability is proved by error analysis and simulation. The method meets the demand of accuracy and stability for the system.

flying saw control system; pulse length; M/T weighted average transition

1001-2265(2016)11-0100-05

10.13462/j.cnki.mmtamt.2016.11.027

2016-01-13

甄自源(1990—)，男，河北邢臺人，大連理工大學碩士研究生，研究方向為電機控制，(E-mail)zhen_ziyuan@163.com；通訊作者：楊振強(1964—)，男，哈爾濱人，大連理工大學副教授，博士，研究方向為電機控制、模糊控制等，(E-mail)yangzq@dlut.edu.cn。

TH162;TG506

A