步進電機加減速曲線的算法研究

2013-08-09 07:41:44肖雅靜顏向乙

電子工業專用設備 2013年8期

崔潔，楊凱，肖雅靜，顏向乙

(中國電子科技集團公司第四十五研究所，北京 100176)

步進電機作為數字控制系統完成數模轉化的執行元件，功能是把電脈沖信號變換為相應角位移或直線位移。步進電機角位移量或線位移量與其接收電脈沖數成正比，轉速或線速度與脈沖頻率成正比。在負載能力范圍內這些正比關系不會因電壓、環境條件等波動而變化，因此應用步進電機的開環控制系統大大簡化。所以在現代工業生產中，步進電機因具有無需反饋就能對位置和速度進行控制，快速啟停和低成本等優勢，在工業自動化控制系統中有極其廣泛應用。

在步進電機實際應用過程中，其良好動態運行性能是控制系統可靠穩定工作的重要前提。尤其是在實時性、快速響應要求高的自動化控制系統中，如何保證步進電機在高速運動過程中頻繁啟停、方向改變和頻率突變時不發生丟步、堵轉和過沖等現象成為關鍵。失步和過沖的發生與步進電機運行速度的變化規律，即步進電機的加減速控制曲線密切相關。因此，針對自動化控制系統步進電機的實際應用，研究步進電機曲線控制的加減速算法具有重要意義。

1 步進電機的控制系統

圖1 步進電機控制系統

從步進電機的控制過程可以看出設計一個好的加減速控制曲線對規劃電機實時快速、準確平穩運動，充分發揮步進電機優勢起到了重要作用。下面對常用的曲線加減速算法進行分析。

2 常用曲線加減速算法

步進電機的加減速過程一般分加速、勻速和減速三個階段，根據目標位移的長度S不同，加減速規劃過程也會不同。假設加速到最大目標速度Vmax的位移為Sacc，從目標速度減速到停止的位移為Sdec，會有以下三種具體情況：

（1）Sacc+Sdec

（2）Sacc+Sdec>S時，加減速曲線僅有加速和減速兩段，電機運行速度小于Vmax。

（3）Sacc+Sdec=S時，加減速曲線也只有加速和減速兩段，但電機的運行速度能達到目標速度Vmax，即電機加速到目標速度后即刻進行減速運動，無勻速運動段。

品質得分在54.70以上的為優質一級烤鴨，市售優質烤鴨中檢測到的9種雜環胺總含量水平為5 757.02～6 859.31ng·g-1。

根據步進電機的運動控制過程，目前常用的步進電機的加減速曲線算法主要有梯形曲線、指數曲線和S形曲線算法。

2.1 梯形曲線

梯形曲線算法的加減速過程分勻加速、勻速和勻減速三個階段。該算法的速度與時間曲線由于呈梯形狀，屬直線型，故名梯形曲線或直線曲線，如圖2所示，同時，圖中也給出了加速度時間關系。速度時間曲線的數學方程式為：

其中，v為t時刻的速度，Vs為起始速度，A為加速度。

圖2 梯形曲線關系圖

由圖2可知，曲線的速度變化不夠光滑，存在突變。在電機運行過程中會發現該算法存在噪聲較大，穩定性不好等缺點，因此該算法不適用短距離、高精度、高速啟停的場合。但由于其算法控制簡單，易于計算實現，節省資源等優點，該曲線算法廣泛應用于長距離升降速要求不高的場合。

2.2 指數曲線

與梯形曲線類似，指數曲線是由于其加減速變化曲線按指數規律變化而得名，速度時間、加速度時間變化曲線如圖3所示。

圖3 指數曲線關系圖

與梯形曲線相比，指數曲線算法光滑性好，運行精度高，但仍然存在速度突變，因此對高速精準要求場合不能很好滿足。另外，由于其在加減速控制過程中有大量指數運算，所以使得該算法計算實現復雜，對硬件的運行能力有較高要求。

2.3 S形曲線

從圖2、圖3可以看出，梯形和指數加速度曲線不連續，均有不同程度的加減速突變。而S形曲線克服了這方面的缺點，保證了加速度曲線的連續性。這樣，S曲線通過對加加速度的控制最大程度減少了速度的沖擊和抖動現象，實現了對電機的快速平穩控制。一般，S曲線的加速度階段分為加加速、勻加速和減加速控制三個階段；減速階段分為減減速、勻減速和加減速三個階段。這樣，加上勻速階段，S曲線通常分為七個階段，如圖4所示。由圖可以看出速度曲線在加減速階段呈S形，因此得名S形加減速算法。

圖4 S曲線關系圖

雖然相比梯形和指數加減速，S形加減速在減少速度沖擊方面有了很大進步，適用于較高要求的加減速過程。但由于其涉及階段較多，實現較復雜，另外其加加速度的不連續性限制了柔性進一步控制。因此本文介紹一種三角曲線加減速算法，該算法既有計算簡單，實現方便等優點，又能提高系統加減速柔性，滿足更高設備系統的應用需求。

3 三角曲線加減速算法設計

3.1 數學函數的構造

由S曲線的缺點可知，設計三角曲線加減速算法最重要的一點是變速過程中要滿足加加速度曲線連續。綜上可知，構造的三角曲線必須滿足以下幾個基本條件：

（1）速度變化曲線變化平穩，不存在速度突變沖擊；

（2）加速度變化曲線連續；

（3）加加速度變化曲線連續；

（4）速度曲線加速變化段的起始和終止、勻速整段、減速變化段的起始和終止加速度均為0，并滿足邊界速度要求。

結合以上要求，現構造三角曲線的加減速數學函數。設速度從Vs經時間Tm變化（加速或減速）到Ve，則根據三角函數的移動變換關系，可以構造變速階段三角曲線數學函數如式(2)：可簡化為：

其中，t∈[0，Tm]。當 t=0 時，V(t)=Vs；當 t=Tm時，V(t)=Ve，滿足速度邊界條件。對公式(3)求導，可得加速度數學函數為：

顯然A(0)=0，A(Tm)=0，滿足加速度邊界條件。對公式(4)求導，易得加加速度數學函數為：

另外，正、余弦三角函數具有平滑連續可導特性。因此綜上分析，構造的數學函數滿足三角曲線加減速算法設計的基本條件。

3.2 算法加減速過程分析

根據加減速運動控制過程可知，加減速產生的位移對規劃運動過程起決定性作用。對公式(3)積分可得算法位移時間關系式：

在三角曲線加減速控制整個過程中，假設能達到的最大速度為Vm，加速起始速度Vs，減速終止速度Ve，總加速時間Tma，總減速時間Tmd，則加、減速的位移公式分別為：

目標位移S與Sa(Tma)、Sd(Tmd)間的關系，決定電機如何根據三角加減速算法規劃運動。為了方便研究，我們設加速初始速度與減速終止速度相等，加速時間與減速時間相同，即Ve=Vs，Tma=Tmd=Tm。這樣，由式(4)易得加速最大加速度Ama與減速最大減速度Amd大小相等，即Ama=Amd=Am。同時，加速與減速兩個過程發生的總位移SAD=Sa(Tma)+Sd(Tmd)可簡化為：易知 A(t)≤Am，另外，結合式(4)可得如下關系式：

解(10)得

從系統運行時間最短考慮，可用式(11)來保證運行時間最短。并且加速階段加速度時間關系圖關于時間軸對稱。

結合公式(11)、(3)和(6)可得速度變化關系式(12)和位移時間關系式(13)，根據式(9)和式(11)可以推得式(14)。

綜上可知，由于Vs為已知值，所以只要給定最大加速度Am、目標速度Vm與目標位移S就可得到三角曲線加減速算法具體規劃運動。當 S>SAD，即。電機有加速、勻速和減速三階段運動；同理當，電機僅有加速和減速兩階段運動。

4 結論

加減速控制算法在步進電機運動過程控制中起著不可替代作用，在工業控制系統中有著廣泛應用。不同的加減速控制算法有不同的控制要求和特點，本文主要對梯形曲線、指數曲線和S形曲線等常用控制算法進行了分析研究，并針對以上算法的不足介紹了一種速度柔性更強的三角曲線算法，表1為上述幾種加減速算法在速度、加速度、加加速度、計算量及實現復雜度上的具體情況。