趙秉鑫,盧 寧*,鹿開(kāi)旭,張洪偉,劉雪巖
(1.北京建筑大學(xué) 機(jī)電與車(chē)輛工程學(xué)院,北京 100032;2.河北建設(shè)集團(tuán)股份有限公司,河北 保定 071000;3.北京理工大學(xué) 機(jī)械與車(chē)輛學(xué)院,北京 100081)
升降機(jī)的聯(lián)動(dòng)裝置是用于同步開(kāi)啟籠門(mén)與層門(mén)到達(dá)設(shè)定位置的裝置,由一個(gè)三相異步電機(jī)驅(qū)動(dòng),通過(guò)傳動(dòng)機(jī)構(gòu)完成開(kāi)關(guān)門(mén)的動(dòng)作。
在其聯(lián)動(dòng)裝置的傳動(dòng)過(guò)程中,圓柱直齒輪、蝸輪蝸桿以及鏈輪、鏈條機(jī)構(gòu)存在齒側(cè)間隙和嚙合誤差等非線(xiàn)性因素,影響了其傳動(dòng)的平穩(wěn)性和精度[1]。在工業(yè)控制領(lǐng)域中,對(duì)聯(lián)動(dòng)裝置傳動(dòng)的控制常常用到常規(guī)PID控制方法,但這種方法在非線(xiàn)性系統(tǒng)控制方面難以達(dá)到滿(mǎn)意的效果。為了保障被控對(duì)象達(dá)到控制目標(biāo),需要設(shè)計(jì)一種非線(xiàn)性控制器來(lái)控制聯(lián)動(dòng)裝置[2]。
針對(duì)非線(xiàn)性系統(tǒng)難以建立準(zhǔn)確數(shù)學(xué)模型的問(wèn)題,蔣晨迪[3]采用了ADAMS與MATLAB聯(lián)合仿真的方法,建立了虛擬仿真平臺(tái),實(shí)現(xiàn)了對(duì)新型扶梯制動(dòng)器控制系統(tǒng)的仿真。冷華杰[4]利用機(jī)電聯(lián)合仿真平臺(tái)對(duì)火炮系統(tǒng)中齒輪傳動(dòng)存在的非線(xiàn)性因素進(jìn)行了研究。
目前,發(fā)展較為成熟的非線(xiàn)性PID控制器的種類(lèi)有神經(jīng)網(wǎng)絡(luò)PID、模糊PID、專(zhuān)家PID等[5]。周?chē)鶾6]設(shè)計(jì)了一種模糊PID控制器,提高了對(duì)送桿機(jī)構(gòu)非線(xiàn)性系統(tǒng)的控制效果。熊中剛[7]采用神經(jīng)網(wǎng)絡(luò)整定PID控制器,實(shí)現(xiàn)了對(duì)平地機(jī)非線(xiàn)性時(shí)變系統(tǒng)的精確控制。楊立秋[8]提出了一種專(zhuān)家PID控制器,在消除船用起重機(jī)的非線(xiàn)性擺動(dòng)方面取得了良好效果。
部分學(xué)者提出的控制器,雖然可以實(shí)現(xiàn)對(duì)非線(xiàn)性系統(tǒng)的精確控制,但其數(shù)學(xué)模型與控制算法復(fù)雜,難以滿(mǎn)足施工升降機(jī)聯(lián)動(dòng)裝置的實(shí)際控制需求。因此,本文設(shè)計(jì)一種模糊PID控制器,利用機(jī)電聯(lián)合仿真技術(shù)進(jìn)行仿真分析,驗(yàn)證控制方案的合理性。
該聯(lián)動(dòng)裝置包含:三相電機(jī)、蝸輪蝸桿減速器、圓柱直齒輪、傳動(dòng)軸、單排鏈輪、防脫鏈板、配重塊、滾珠絲杠螺母、直線(xiàn)導(dǎo)軌、層門(mén)撥塊、機(jī)架等,其聯(lián)動(dòng)裝置傳動(dòng)簡(jiǎn)圖如圖1所示。
圖1 聯(lián)動(dòng)裝置傳動(dòng)簡(jiǎn)圖
聯(lián)動(dòng)裝置的工作原理為:由三相電機(jī)輸出動(dòng)力,電機(jī)軸帶動(dòng)蝸桿轉(zhuǎn)動(dòng)與蝸輪相嚙合,將動(dòng)力輸出給傳動(dòng)軸,傳動(dòng)軸上布置大齒輪與兩個(gè)單排鏈輪;大齒輪與小齒輪通過(guò)嚙合傳遞動(dòng)力,帶動(dòng)絲杠旋轉(zhuǎn),使螺母作直線(xiàn)運(yùn)動(dòng),完成對(duì)層門(mén)的開(kāi)關(guān)動(dòng)作;兩個(gè)單排鏈輪與鏈條嚙合,完成籠門(mén)的開(kāi)關(guān)動(dòng)作。
筆者采用SolidWorks軟件,對(duì)聯(lián)動(dòng)裝置的各個(gè)零部件進(jìn)行參數(shù)化建模,簡(jiǎn)化與本次研究無(wú)關(guān)的零部件。聯(lián)動(dòng)裝置三維模型如圖2所示。
圖2 聯(lián)動(dòng)裝置三維模型
根據(jù)聯(lián)動(dòng)裝置的控制要求,確定控制系統(tǒng)硬件??刂葡到y(tǒng)硬件主要包括PLC、通用變頻器和編碼器。該控制系統(tǒng)以層門(mén)為控制對(duì)象,由PLC控制器控制。
聯(lián)動(dòng)裝置控制系統(tǒng)原理框圖如圖3所示。
圖3 聯(lián)動(dòng)裝置控制系統(tǒng)原理框圖
控制信號(hào)為層門(mén)運(yùn)動(dòng)的位移信號(hào),編碼器安裝在絲杠末端,用于檢測(cè)絲杠轉(zhuǎn)速。通過(guò)公式推算得到層門(mén)的位移為:
(1)
式中:n—絲杠轉(zhuǎn)速;Ph—絲杠導(dǎo)程。
筆者將誤差與誤差變化率作為模糊PID控制器的輸入,通過(guò)查詢(xún)嵌入在PLC中的模糊控制表整定KP、KI、KD參數(shù),輸出模擬量信號(hào),調(diào)節(jié)通用變頻器的輸出頻率和電壓,控制電機(jī)轉(zhuǎn)速,進(jìn)而控制層門(mén)撥塊的線(xiàn)位移,達(dá)到對(duì)層門(mén)運(yùn)動(dòng)的半閉環(huán)控制。
在工程實(shí)際中,通常將采用恒壓頻比控制方式的變頻器的傳遞函數(shù)簡(jiǎn)化成為慣性環(huán)節(jié)[9],即:
f=Kfur
(2)
式中:f—變頻器輸出頻率;Kf—變頻器增益系數(shù);ur—變頻器輸入模擬量電壓。
電機(jī)額定輸入電壓UN為:
UN=KNfN
(3)
式中:fN—電機(jī)額定輸入頻率;KN—變頻器增益系數(shù)。
Uc=K1f=KNKfur
(4)
故變頻器的傳遞函數(shù)為:
(5)
式中:K1—電壓頻率轉(zhuǎn)換系數(shù);T1—時(shí)間常數(shù)(變頻器頻率變化時(shí)間)。
變頻器參數(shù)如表1所示。
表1 變頻器參數(shù)表
建立三相異步電機(jī)的數(shù)學(xué)模型通常需要忽略空間和時(shí)間諧波、磁路飽和以及鐵心損耗的影響[10]。接下來(lái)討論基于恒壓頻比控制方式的三相電機(jī)數(shù)學(xué)模型的建模過(guò)程。
根據(jù)電機(jī)正常工作狀態(tài)下的近似等效電路,折算到定子側(cè)的轉(zhuǎn)子電流表達(dá)式為:
(6)
根據(jù)機(jī)電能量轉(zhuǎn)換關(guān)系得到電機(jī)的電磁轉(zhuǎn)矩為:
(7)
式中:Pm—電動(dòng)機(jī)電磁功率;ωm—同步電磁角速度。
忽略勵(lì)磁電流,即C1≈1,將簡(jiǎn)化后的式(6)代入到式(7)得:
(8)
式中:np—電機(jī)磁極對(duì)數(shù)。
(9)
根據(jù)電機(jī)的參數(shù)可得轉(zhuǎn)子每相電阻為:
(10)
根據(jù)運(yùn)動(dòng)平衡方程,可得:
(11)
將式(9)代入式(11),得到轉(zhuǎn)速與輸入電壓的微分方程為:
(12)
式中:J—負(fù)載折算到電機(jī)軸的轉(zhuǎn)動(dòng)慣量;B—粘滯阻尼系數(shù);TL—負(fù)載轉(zhuǎn)矩。
三相異步電機(jī)參數(shù)如表2所示。
表2 三相異步電機(jī)參數(shù)表
在MATLAB/Simulink模塊中建立的變頻電機(jī)仿真模型如圖4所示。
圖4 變頻電機(jī)仿真模型
在蝸輪蝸桿、圓柱直齒輪與鏈輪鏈條的運(yùn)動(dòng)過(guò)程中,由于外界因素和自身結(jié)構(gòu)的特點(diǎn)導(dǎo)致嚙合不平穩(wěn),使得傳動(dòng)不均勻,很難建立準(zhǔn)確的非線(xiàn)性動(dòng)力學(xué)模型。因此,要在ADAMS中建立傳動(dòng)機(jī)構(gòu)的虛擬樣機(jī),準(zhǔn)確地模擬嚙合接觸的過(guò)程。
傳動(dòng)機(jī)構(gòu)動(dòng)力學(xué)模型的相關(guān)參數(shù)主要由其自身尺寸、材料屬性、實(shí)際工況等決定,根據(jù)相關(guān)公式及推薦參數(shù)得到參數(shù)設(shè)定值。
動(dòng)力學(xué)模型接觸參數(shù)設(shè)定值如表3所示。
表3 動(dòng)力學(xué)模型接觸參數(shù)設(shè)定表
筆者采用ADAMS中Hertz接觸理論的Impact模型確定接觸點(diǎn)的法向接觸力,其函數(shù)表達(dá)式為:
(13)
式中:K—接觸剛度系數(shù);δ—兩物體接觸滲透深度;e—?jiǎng)偠戎笖?shù);dmax—最大阻尼完全作用距離;Cmax—最大阻尼。
根據(jù)Coulomb摩擦方法來(lái)計(jì)算接觸點(diǎn)切向接觸力,其函數(shù)表達(dá)式為:
Fs=-Fn·step(v1,-Vs,-1,Vs,1)·
step(|v1|,Vs,fs,Vd,fd)
(14)
式中:v1—相對(duì)滑移速度;Vs—最大靜摩擦相對(duì)滑移速度;Vd—?jiǎng)幽Σ料鄬?duì)滑移速度;fs—靜摩擦系數(shù);fd—?jiǎng)幽Σ料禂?shù)。
在各個(gè)零部件之間添加約束,聯(lián)動(dòng)裝置動(dòng)力學(xué)模型系統(tǒng)拓?fù)?如圖5所示。
圖5 聯(lián)動(dòng)裝置動(dòng)力學(xué)模型系統(tǒng)拓?fù)鋱D
聯(lián)動(dòng)裝置動(dòng)力學(xué)模型如圖6所示。
圖6 聯(lián)動(dòng)裝置動(dòng)力學(xué)模型
機(jī)電聯(lián)合仿真控制系統(tǒng)如圖7所示。
圖7 機(jī)電聯(lián)合仿真控制系統(tǒng)
引入模糊PID控制策略對(duì)層門(mén)進(jìn)行位置控制,層門(mén)位移的誤差信號(hào)通過(guò)模糊PID控制器進(jìn)行調(diào)節(jié),設(shè)定通用變頻器輸入模擬量的飽和信號(hào)模塊(即對(duì)模擬量輸入限幅),模擬PLC通過(guò)D/A轉(zhuǎn)換輸出0~10 V的模擬量信號(hào)來(lái)控制變頻器的輸出電壓,根據(jù)西門(mén)子PLC中PID的算法原理,在MATLAB/Simulink中建立離散PID模塊[11]。設(shè)定變頻電機(jī)輸出轉(zhuǎn)速的飽和信號(hào)模塊(即對(duì)輸出轉(zhuǎn)速限幅)。在ADAMS中建立一個(gè)狀態(tài)變量(即電機(jī)轉(zhuǎn)速)作為輸入;3個(gè)狀態(tài)變量(即負(fù)載力矩、層門(mén)位移和層門(mén)直線(xiàn)運(yùn)動(dòng)速度)作為輸出,完成對(duì)控制系統(tǒng)模型的建立。
目前,因其控制性能和控制復(fù)雜性相對(duì)較好,二維模糊控制器得到了廣泛應(yīng)用[12]。在該控制系統(tǒng)中,以層門(mén)撥塊的理論位移與實(shí)際位移的誤差量E和誤差變化率EC作為模糊控制器的輸入,通過(guò)模糊控制器輸出參數(shù)ΔKp、ΔKI、ΔKD,對(duì)傳統(tǒng)PID控制器的參數(shù)進(jìn)行整定,以適應(yīng)復(fù)雜的控制模型。
ΔKp的模糊規(guī)則如表4所示。
表4 ΔKp的模糊控制規(guī)則表
ΔKI的模糊規(guī)則如表5所示。
ΔKD的模糊規(guī)則如表6所示。
表5 ΔKI的模糊控制規(guī)則表
表6 ΔKD的模糊控制規(guī)則表
采用Mamdani模糊推理方法[15,16],得到各個(gè)輸出參數(shù)的模糊控制規(guī)則曲面。
ΔKp模糊控制規(guī)則曲面如圖8所示。
圖8 ΔKp模糊控制規(guī)則曲面
ΔKI模糊控制規(guī)則曲面如圖9所示。
圖9 ΔKI模糊控制規(guī)則曲面
ΔKD模糊控制規(guī)則曲面如圖10所示。
圖10 ΔKD模糊控制規(guī)則曲面
筆者采用MATLAB/Simulink與ADAMS聯(lián)合仿真的方法對(duì)升降機(jī)聯(lián)動(dòng)裝置的控制系統(tǒng)進(jìn)行仿真,采用工程上整定PID參數(shù)的方法對(duì)PID的KP、KI、KD進(jìn)行初步確定。
控制系統(tǒng)仿真參數(shù)如表7所示。
表7 控制系統(tǒng)仿真參數(shù)表
在控制系統(tǒng)的兩種工況下,分別對(duì)給定控制信號(hào)的響應(yīng)進(jìn)行仿真分析。
控制系統(tǒng)跟蹤工況一位移信號(hào)的響應(yīng)曲線(xiàn)如圖11所示。
圖11 控制系統(tǒng)跟蹤工況一位移信號(hào)的響應(yīng)曲線(xiàn)
圖11中,設(shè)定層門(mén)的開(kāi)度為1.3 m,層門(mén)的位移控制信號(hào)采用S-Function進(jìn)行編寫(xiě);設(shè)定層門(mén)在t=1 s時(shí)刻以0.32 m/s速度開(kāi)始勻速運(yùn)動(dòng),在t=5 s時(shí)刻運(yùn)動(dòng)停止,到達(dá)目標(biāo)位置。
控制系統(tǒng)跟蹤工況一位移信號(hào)的誤差曲線(xiàn)如圖12所示。
圖12 控制系統(tǒng)跟蹤工況一位移信號(hào)的誤差曲線(xiàn)
圖12中,在傳統(tǒng)PID控制下,控制系統(tǒng)的最大誤差為0.223 m,控制系統(tǒng)的穩(wěn)態(tài)誤差為0.016 m,采取模糊PID控制后,控制系統(tǒng)的最大誤差為0.158 m,控制系統(tǒng)的穩(wěn)態(tài)誤差為0.002 m;系統(tǒng)的最大誤差下降了29.2%,穩(wěn)態(tài)誤差下降了87.5%。
結(jié)合圖11和圖12可以看出,模糊PID對(duì)位移信號(hào)的跟隨性?xún)?yōu)于傳統(tǒng)PID,控制精度得到提高。
控制系統(tǒng)跟蹤工況二位移信號(hào)的響應(yīng)曲線(xiàn)如圖13所示。
圖13 控制系統(tǒng)跟蹤工況二位移信號(hào)的響應(yīng)曲線(xiàn)
圖13中,出于安全考慮,在層門(mén)運(yùn)行過(guò)程中發(fā)現(xiàn)危險(xiǎn)情況時(shí),需要對(duì)處于運(yùn)行狀態(tài)的層門(mén)發(fā)出立即歸位的操作指令,設(shè)定層門(mén)在1 s 通過(guò)仿真結(jié)果可以看出:在傳統(tǒng)PID控制下,跟蹤階躍信號(hào)的過(guò)程中,系統(tǒng)的調(diào)節(jié)時(shí)間為3.3 s;模糊PID控制下,跟蹤階躍信號(hào)的過(guò)程中,系統(tǒng)的調(diào)節(jié)時(shí)間則下降至2.1 s,系統(tǒng)的響應(yīng)速度提升了36.4%。 因此,相比于使用傳統(tǒng)PID控制器,模糊PID控制策略在跟蹤系統(tǒng)突變信號(hào)方面的能力明顯提升。 本文對(duì)升降機(jī)的聯(lián)動(dòng)裝置的原理和結(jié)構(gòu)進(jìn)行了分析,建立了通用變頻器與變頻電機(jī)的數(shù)學(xué)模型,及傳動(dòng)機(jī)構(gòu)的動(dòng)力學(xué)模型和控制系統(tǒng)模型;采用MATLAB/Simulink與ADAMS機(jī)電聯(lián)合仿真的方法,對(duì)升降機(jī)聯(lián)動(dòng)裝置的控制系統(tǒng)進(jìn)行了仿真分析。研究結(jié)果表明: (1)在工況一下,相較于傳統(tǒng)PID控制器,模糊PID控制器對(duì)給定信號(hào)的跟隨性能更好,系統(tǒng)的最大誤差下降29.2%,穩(wěn)態(tài)誤差下降87.5%; (2)在工況二下,相較于傳統(tǒng)PID控制器,模糊PID控制器對(duì)給定信號(hào)的響應(yīng)速度更快,系統(tǒng)的響應(yīng)速度提升36.4%; (3)采用模糊PID控制策略提升了系統(tǒng)的控制精度,滿(mǎn)足了聯(lián)動(dòng)裝置的控制要求。 今后,筆者將在升降機(jī)聯(lián)動(dòng)裝置物理樣機(jī)上做進(jìn)一步的研究,并對(duì)設(shè)備進(jìn)行更好的現(xiàn)場(chǎng)調(diào)試。5 結(jié)束語(yǔ)