****力矩跟隨的混合式步進(jìn)電機(jī)微機(jī)控制系統(tǒng)
孫建輝(浙江工業(yè)大學(xué)杭州310014)
【摘 要】根據(jù)混合式步進(jìn)電動(dòng)機(jī)的運(yùn)行矩頻特性,推導(dǎo)出一種具有****力矩跟隨的快速加減速算法,同時(shí)給出其適于微機(jī)實(shí)現(xiàn)的形式及相應(yīng)于算法的微機(jī)實(shí)現(xiàn)的硬件和軟件技術(shù),并利用現(xiàn)場(chǎng)試驗(yàn)和hdj003平面關(guān)節(jié)型裝配機(jī)器人的應(yīng)用,證明算法的正確性以及軟硬件設(shè)計(jì)的合理性。
l引 言
混合式 步進(jìn)電機(jī)因其具有運(yùn)行頻率高、動(dòng)態(tài)力矩大、波動(dòng)小、運(yùn)轉(zhuǎn)平穩(wěn)、低噪聲、低功耗、定位精度和分辨率高等優(yōu)點(diǎn),已廣泛應(yīng)用于諸如數(shù)控裝置、機(jī)械手、商業(yè)機(jī)器、自動(dòng)化儀器、印刷、服裝加工和包裝設(shè)備、軍事裝備等機(jī)電一體化產(chǎn)品和設(shè)備中,與永磁式步進(jìn)電動(dòng)機(jī)相比,混合式步進(jìn)電動(dòng)機(jī)具有更良好的高頻運(yùn)行性能,其****運(yùn)行頻率高達(dá)50khz以上,轉(zhuǎn)速達(dá)6 000r/min,在實(shí)際應(yīng)用中,為了充分利用其優(yōu)良動(dòng)態(tài)性能,首先必須解決的關(guān)鍵技術(shù)是要有合理的加減速過程,即所謂的升降頻控制,若加減速過程不合理,輕則出現(xiàn)丟步,且升降速時(shí)間延長(zhǎng),重則輸出力矩達(dá)不到設(shè)計(jì)指標(biāo),并且遠(yuǎn)達(dá)不到50khz的電機(jī)設(shè)計(jì)高頻性能。雖然有關(guān)永磁式步進(jìn)電動(dòng)機(jī)的升降頻研究已有許多報(bào)道,但混合式步進(jìn)電動(dòng)機(jī)的升降頻問題遠(yuǎn)未得到圓滿解決。由于在加速過程中,加速力矩是隨頻率增高而變小的,兩者呈嚴(yán)重非線性關(guān)系,且不可能得到解析函數(shù)表達(dá)式。再加上應(yīng)用中往往要充分發(fā)揮混合式步進(jìn)電機(jī)的高頻性能,實(shí)踐證明,直接應(yīng)用文獻(xiàn)2~7中的結(jié)果都不盡合理,例如三段曲線逼近法,在低頻,尤其在高頻段顯然不適合混合式步進(jìn)電機(jī);由于高頻段力矩與頻率關(guān)系的嚴(yán)重非線性,用單一形式的升降頻曲線,也是不合理的,又由于步進(jìn)電機(jī)的結(jié)構(gòu)、驅(qū)動(dòng)方式及負(fù)載形式等因素都會(huì)影響矩頻特性,因此,所謂起動(dòng)后****加速的統(tǒng)一優(yōu)化曲線方法,存在更嚴(yán)重的不足。由于混合式步進(jìn)電機(jī)高速運(yùn)行的特點(diǎn)、不合理的加減速規(guī)律、復(fù)雜的算法以及低質(zhì)量的硬件設(shè)計(jì),都不能達(dá)到高速運(yùn)行,并將導(dǎo)致升降速的失敗。本文根據(jù)混合式步進(jìn)電機(jī)的結(jié)構(gòu)參數(shù)、起動(dòng)及運(yùn)行矩頻特性,給出一種具有****力矩跟隨的混合式步進(jìn)電機(jī)加減速控制算法和軟件,并采用8086cpu和pal與82c54構(gòu)成的計(jì)數(shù)器及8259中斷控制器等組成高性能硬件線路,以實(shí)現(xiàn)混合式步進(jìn)電機(jī)的****力矩快速平穩(wěn)加減速和高頻運(yùn)行,并且具有相當(dāng)高的定位精度。
2基本算法
混合式步進(jìn)電機(jī)的典型運(yùn)行矩頻特性如圖1所示。圖1表明,在低頻段(一般2khz左右),混合式電機(jī)有較高的輸出力矩,且矩頻特性較硬。當(dāng)頻率大于2khz后,輸出力矩隨頻率的增高快速下降。
當(dāng)頻率高達(dá)一定程度后,其對(duì)應(yīng)力矩的下降率則相對(duì)減小,實(shí)踐證明,在低頻段,混合式步進(jìn)電機(jī)直接起動(dòng),仍能保證****輸出力矩。當(dāng)頻率增高時(shí),為保證****力矩,必須滿足旋轉(zhuǎn)體的動(dòng)力學(xué)方程。
式中 tm——電機(jī)輸出轉(zhuǎn)矩****值
t1——總負(fù)載轉(zhuǎn)矩
j——電機(jī)轉(zhuǎn)子及負(fù)載的總轉(zhuǎn)動(dòng)慣量
θ——電機(jī)轉(zhuǎn)子轉(zhuǎn)過的角度若設(shè)步距角為ko,則
從而有
假設(shè)加速過程從運(yùn)行矩頻特性曲線上某點(diǎn)pi(fi,ti)經(jīng)微小移動(dòng)到達(dá)pi+1(fi+1,ti+1),這里fi+1=fi+△fi,△fi,ti+1=ti+△ti,為得到從pi到pi+1的矩頻特性,可根據(jù)pi點(diǎn)所在圖1曲線上的具體位置,經(jīng)過一次曲線、二次曲線或高次曲線,甚至指數(shù)曲線的擬合得到具有相當(dāng)精度的近似曲線。為推導(dǎo)方便明了,文中僅給出采用一次曲線逼近的結(jié)果,更復(fù)雜情況可同理類推。
由假設(shè)曲線可得到pi與pi+1問的矩頻特性。
式中
若設(shè)β=-kfi+ti,則由式(3)和式(4)可知:
式(5)即為步進(jìn)電機(jī)保持****力矩跟隨必須滿足的加速度與頻率的關(guān)系,它與對(duì)應(yīng)加速時(shí)刻的力矩、頻率以及加速速率有關(guān),以pi點(diǎn)為初值,求解式(5)可得:
經(jīng)整理簡(jiǎn)化后得到
式中
 1/τ,為加速時(shí)間常數(shù),根據(jù)前面的假設(shè),可證明ti=o,以及
式(7)即為滿足運(yùn)行矩頻特性的頻率f(t)與時(shí)間t的函數(shù)關(guān)系。由該式即可求得具有****力矩跟隨的步進(jìn)電機(jī)加速規(guī)律。
可見,上述方法提供了一條靈活方便的高精度逼近運(yùn)行矩頻特性的加減速途徑,具體計(jì)算時(shí),可以根據(jù)運(yùn)行矩頻特性上某段的非線性程度,合理選擇pi和pi+1,然后確定時(shí)間t的范圍,并由式(7)得到該區(qū)間上頻率f(t)與時(shí)間t的關(guān)系。譬如某段矩頻特性曲線線性化程度較好,則可取該整段為一個(gè)升頻區(qū)間;若某段有嚴(yán)重非線性,則升頻規(guī)律也將會(huì)隨時(shí)間發(fā)生連續(xù)不斷的變化。
然而,以上算法還不適合直接應(yīng)用于計(jì)算機(jī)控制,必須將連續(xù)形式化成離散形式,給出相應(yīng)的脈沖分配,下面給出簡(jiǎn)略的推導(dǎo),假設(shè)選定pi和pi+1,且在tn的時(shí)間內(nèi),有n個(gè)脈沖,對(duì)f(t)作時(shí)間的積分,即
第n+1個(gè)脈沖:
設(shè)△tn=tn+1-tn,將式(9)減式(8)得:
式(12)為超越方程,可采用牛頓迭代法為△tn。
牛頓迭代法公式:
對(duì)于式(13),p1,p2,p3為已知參數(shù),tn=tn-1+tk,t0=0,tk為所選的迭代初值。
3微機(jī)實(shí)現(xiàn)
為實(shí)現(xiàn)混合式步進(jìn)電動(dòng)機(jī)的高速****力矩跟隨的加減速過程,必須設(shè)計(jì)一套高性能,尤其在高頻段具有快速跟隨性能的硬件系統(tǒng)。為此,設(shè)計(jì)了以intel8086為主cpu。pal及計(jì)數(shù)器82c54和中斷控制器32c59a為核心的硬件線路,保證整個(gè)控制系統(tǒng)功能的實(shí)現(xiàn),控制器的硬件結(jié)構(gòu)框圖如圖2所示。
8086cpu的工作頻率為5mhz。除完成系統(tǒng)的主控任務(wù)外,還可作簡(jiǎn)單的加速規(guī)律計(jì)算,更復(fù)雜的計(jì)算可由上級(jí)pc饑完成,82c59、pal、82c54和8255組成實(shí)時(shí)加減速系統(tǒng)的核心,該結(jié)構(gòu)的主要優(yōu)點(diǎn)是利用中斷控制器和定時(shí)計(jì)數(shù)器以及并行口的各自功能,確保高速力矩跟隨控制任務(wù)的準(zhǔn)確完成,反饋回路主要是為了提高系統(tǒng)控制精度和電機(jī)運(yùn)行平穩(wěn)性而設(shè)計(jì)。
相應(yīng)的控制系統(tǒng)軟件主要由主控模塊、運(yùn)算模塊、通訊監(jiān)控模塊、中斷模塊以及反饋處理模塊等組成,如圖3所示,主控模塊用于以****力矩跟隨策略控制步進(jìn)電機(jī)起動(dòng)、運(yùn)行和停止。運(yùn)算模塊用于按本文推導(dǎo)的方法給出****加減速規(guī)律及數(shù)據(jù),通訊監(jiān)控模塊建立本控制裝置與其它微機(jī)系統(tǒng)的聯(lián)系,實(shí)時(shí)傳輸有關(guān)信息,以及對(duì)參數(shù)等的監(jiān)控。中斷模塊主要用于保證實(shí)時(shí)高速性能的完成,反饋處理模塊用于反饋信息檢測(cè)、波形處理和電機(jī)轉(zhuǎn)角的實(shí)時(shí)補(bǔ)償。
4試驗(yàn)及實(shí)時(shí)運(yùn)行
利用所設(shè)計(jì)的****力矩跟隨微機(jī)和控制系統(tǒng)對(duì)幾種型號(hào)的混合式步進(jìn)電機(jī)進(jìn)行實(shí)驗(yàn),其結(jié)果都相當(dāng)滿意,例如對(duì)90by(g-50型五相混合式步進(jìn)電機(jī),以2.00khz頻率起動(dòng),****運(yùn)行頻率可達(dá)50khz,無失步現(xiàn)象。本系統(tǒng)在hdj003平面關(guān)節(jié)型裝配機(jī)器人控制中應(yīng)用已有5年之久,運(yùn)行一直平穩(wěn)可靠,****裝配速度達(dá)1.25m/s,驅(qū)動(dòng)大小關(guān)節(jié)的兩臺(tái)90byg-50型混合式步進(jìn)電機(jī),****運(yùn)行頻率在35khz以上,同時(shí)該機(jī)器人還具有較高裝配精度,實(shí)際達(dá)±o.03mm。
5結(jié)語
本文利用運(yùn)行矩頻特性,給出一種實(shí)用的混合式步進(jìn)電動(dòng)機(jī)具有****輸出力矩跟隨的加減速算法,由此而設(shè)計(jì)的軟硬件系統(tǒng),結(jié)構(gòu)合理、性能優(yōu)越可靠,尤其具有良好的高頻實(shí)時(shí)功能。所設(shè)計(jì)系統(tǒng)的現(xiàn)場(chǎng)試驗(yàn)及實(shí)際運(yùn)行,證明了算法的正確可行性和系統(tǒng)的合理性,為解決混合式步進(jìn)電機(jī)的高頻運(yùn)行、****力矩跟隨和****軟硬件配置等提供了一種簡(jiǎn)捷可行的有效辦法。
參 考 文 獻(xiàn)
1 孫龍生.五相混合式步進(jìn)電動(dòng)機(jī)特點(diǎn)及負(fù)載匹配.微特電機(jī),1988(5)
2李明泉.功率步進(jìn)電機(jī)****升降頻過程三段曲線逼近法.微電機(jī),1987(4)
3 趙家森.用微機(jī)控制步進(jìn)電機(jī)的升降速.微特電機(jī),1988(2)
4華誠.用單片微機(jī)實(shí)現(xiàn)步進(jìn)電機(jī)優(yōu)化控制.微特電機(jī),1990(2)
5 陳愛民.步進(jìn)電機(jī)拋物線型升降頻曲線介紹.微特電機(jī),1991(6)
6莫錦秋.基于存儲(chǔ)技術(shù)的步進(jìn)電機(jī)升降頻過程控制.微特電機(jī),1992(6)
7羅安.步進(jìn)電動(dòng)機(jī)的****控制.微電機(jī),1 996(2)
8 hd.j003型裝配機(jī)器人技術(shù)和設(shè)計(jì)報(bào)告.杭州電子工業(yè)學(xué)院鑒定資料,1 990.
中國步進(jìn)電機(jī)網(wǎng)淘寶店:http://shop57539716.taobao.com |