馬麗瓊,盧鵬
(641300 四川省 資陽(yáng)市 四川希望汽車(chē)職業(yè)學(xué)院)
汽車(chē)外后視鏡是汽車(chē)的重要安全件,國(guó)內(nèi)部分企業(yè)生產(chǎn)的汽車(chē)電動(dòng)折疊外后視鏡產(chǎn)品在折疊運(yùn)轉(zhuǎn)時(shí)存在動(dòng)態(tài)特性差和耗能大的問(wèn)題,造成產(chǎn)品的市場(chǎng)競(jìng)爭(zhēng)力弱[1]。因此,設(shè)計(jì)合理的控制系統(tǒng),優(yōu)化啟動(dòng)特性和轉(zhuǎn)速跟隨特性,有利于改善其動(dòng)態(tài)特性、減少能耗、提高產(chǎn)品質(zhì)量,有利于提高國(guó)內(nèi)企業(yè)在后視鏡市場(chǎng)的競(jìng)爭(zhēng)力[2]。
本文采用CATIA 軟件建模得到汽車(chē)外后視鏡電動(dòng)折疊系統(tǒng)模型,再建立基于ADAMS 的多體動(dòng)力學(xué)模型,然后進(jìn)入控制系統(tǒng)設(shè)計(jì)。該控制系統(tǒng)是基于ADAMS 與MATLAB 的電動(dòng)折疊器PID 控制聯(lián)合仿真。
汽車(chē)外后視鏡電動(dòng)折疊器的控制系統(tǒng)分為輸入部分、控制部分以及輸出部分[3]??刂撇糠质俏⒖貑卧狤CU,它整合了以往電控方式中的繼電器型限位開(kāi)關(guān),通過(guò)輸出控制信號(hào)至執(zhí)行器實(shí)現(xiàn)電路通斷動(dòng)作,執(zhí)行器部分包括驅(qū)動(dòng)電路和折疊電機(jī)[4]。輸入部分包含指令信號(hào)輸入電路,也包含傳感器,即電流傳感器和轉(zhuǎn)速傳感器[5-6]。圖1 所示為后視鏡折疊控制系統(tǒng)的結(jié)構(gòu)圖。
圖1 后視鏡折疊控制系統(tǒng)結(jié)構(gòu)圖Fig.1 Composition of rearview mirror folding control system
該控制系統(tǒng)的控制策略為,輸入部分通過(guò)信號(hào)輸入電路送進(jìn)ECU 單元,經(jīng)ECU 內(nèi)部程序發(fā)出信號(hào)控制驅(qū)動(dòng)電路,進(jìn)而控制折疊電機(jī)[7]。折疊電機(jī)的輸出量是轉(zhuǎn)速,通過(guò)轉(zhuǎn)速傳感器反饋給ECU 進(jìn)行誤差修正。電機(jī)另一個(gè)反饋量是電樞電流,到位后,電機(jī)轉(zhuǎn)動(dòng)受阻發(fā)生堵轉(zhuǎn),電流迅速增大,此時(shí)通過(guò)電流傳感器即可發(fā)送信號(hào)給ECU,ECU 中斷驅(qū)動(dòng)電路,從而使電機(jī)停止轉(zhuǎn)動(dòng)[8]。
汽車(chē)外后視鏡電動(dòng)折疊器控制系統(tǒng)首先需要根據(jù)系統(tǒng)總體方案進(jìn)行硬件系統(tǒng)設(shè)計(jì)與選取[9]。
轉(zhuǎn)速傳感器測(cè)量的是電機(jī)轉(zhuǎn)速。光電式傳感器受電磁的干擾較小,安裝位置靈活,所以選擇光電式轉(zhuǎn)速傳感器作為測(cè)速傳感器,型號(hào)為GK122。
該系統(tǒng)不需要測(cè)出具體的電流數(shù)值,只需事先限定一個(gè)限定值,當(dāng)電機(jī)堵轉(zhuǎn),電流超過(guò)限定值時(shí),電流傳感器發(fā)出高電平;電機(jī)轉(zhuǎn)動(dòng)過(guò)程中,電樞電流未超過(guò)限定值時(shí),發(fā)出低電平信號(hào)。只有高電平信號(hào)反饋回ECU,才能讓ECU 中斷驅(qū)動(dòng)電路,使電機(jī)停轉(zhuǎn)。所以電流計(jì)只需具備比較限流功能即可,綜合模塊特點(diǎn),選擇WCS1700 電流檢測(cè)一體模塊。該模塊主要有2 個(gè)功能:一是經(jīng)過(guò)運(yùn)放跟隨的模擬信號(hào),適用于A/D 轉(zhuǎn)換;二是開(kāi)關(guān)信號(hào),可預(yù)先設(shè)定限流值,當(dāng)實(shí)際電流值大于預(yù)設(shè)值時(shí),開(kāi)關(guān)信號(hào)會(huì)由低電平變?yōu)楦唠娖剑⒂蠰ED 指示燈指示,簡(jiǎn)單易用。模塊具有響應(yīng)時(shí)間快、靈敏度好、電頻切換穩(wěn)定、電流設(shè)置方便、限流設(shè)置方便等特點(diǎn)。
軟件系統(tǒng)工作流程設(shè)計(jì)包括主程序設(shè)計(jì)、子程序設(shè)計(jì)[10]。
主程序設(shè)計(jì)為循環(huán)結(jié)構(gòu),通過(guò)不斷運(yùn)行采集各傳感器發(fā)來(lái)的信號(hào),識(shí)別車(chē)輛電控系統(tǒng)的狀態(tài)和駕駛員對(duì)后視鏡輸入的動(dòng)作信號(hào),流程圖如圖2 所示。駕駛員啟動(dòng)車(chē)輛,控制系統(tǒng)就開(kāi)始工作。首先進(jìn)行參數(shù)變量的定義與初始化,接著檢測(cè)電源狀態(tài),先判斷控制電流是否過(guò)載,如果有過(guò)載,則進(jìn)行過(guò)載止停子程序,否則進(jìn)行動(dòng)作信號(hào)判斷。如果有動(dòng)作信號(hào),則執(zhí)行動(dòng)作子程序,否則返回讀入控制參數(shù)再次循環(huán)。
圖2 控制系統(tǒng)主程序控制流程圖Fig.2 Main program control flow of control system
子程序包括執(zhí)行動(dòng)作子程序與過(guò)流停止子程序。執(zhí)行動(dòng)作子程序流程如圖3 所示。當(dāng)控制模塊讀取到動(dòng)作信號(hào)時(shí),執(zhí)行動(dòng)作子程序?qū)π盘?hào)進(jìn)行判斷。首先控制模塊將動(dòng)作信號(hào)送至ECU,ECU 發(fā)出控制信號(hào)給驅(qū)動(dòng)電路,驅(qū)動(dòng)電路控制電機(jī)運(yùn)轉(zhuǎn),然后通過(guò)電流檢驗(yàn)?zāi)K對(duì)電樞電流進(jìn)行判斷,如果電機(jī)電流沒(méi)有超過(guò)堵轉(zhuǎn)電流值,系統(tǒng)判斷電樞電流沒(méi)有過(guò)載,便會(huì)接著讀取后視鏡殼體轉(zhuǎn)速,將其返回給ECU 的PID 模塊進(jìn)行反饋調(diào)節(jié),繼續(xù)控制驅(qū)動(dòng)電路。直至收到電流過(guò)載信號(hào),此時(shí)返回出口,回到主程序判斷過(guò)程。
圖3 執(zhí)行動(dòng)作子程序流程Fig.3 Subroutine flow of executing action
過(guò)流止停程序流程如圖4 所示。當(dāng)電流校驗(yàn)?zāi)K接收到電路過(guò)載信號(hào)時(shí),就會(huì)給ECU 發(fā)出信號(hào)讓其中斷電機(jī)的驅(qū)動(dòng)電路,使電機(jī)停止轉(zhuǎn)動(dòng),并返回出口,回到主程序的讀入控制參數(shù)步驟。
圖4 過(guò)流止停程序流程Fig.4 Program flow of overcurrent stop
基于ADAMS 與MATLAB 的電動(dòng)折疊器PID控制聯(lián)合仿真包括機(jī)構(gòu)模型參數(shù)設(shè)置、MATLAB控制系統(tǒng)建立、PID 控制參數(shù)調(diào)試和結(jié)果分析[11]。
創(chuàng)建狀態(tài)變量,將后視鏡機(jī)構(gòu)模型的電機(jī)角轉(zhuǎn)速作為仿真模塊的輸入,將殼體的角轉(zhuǎn)速和轉(zhuǎn)動(dòng)角度作為輸出,設(shè)置了4 個(gè)狀態(tài)變量M_V,Velocity,Angle,電機(jī)軸力矩M_Torque。
指定狀態(tài)變量,要將其設(shè)定為輸出或者是輸入。通過(guò)ADAMS 的Data Element 工具,可以創(chuàng)建Plant Input 和Plant Output,在其變量名的一欄中選擇對(duì)應(yīng)的輸入變量或者輸出變量。至此,在ADAMS 中把模型的仿真模塊參數(shù)設(shè)置完畢。
導(dǎo)出控制參數(shù),通過(guò)ADAMS/Control 模塊中的導(dǎo)出選項(xiàng),按圖5 所示,根據(jù)輸入?yún)?shù)M_V,輸出參數(shù)Velocity,Angle,MOTION_T,設(shè)置控制參數(shù)導(dǎo)出。設(shè)置相關(guān)參數(shù)之后,就能導(dǎo)出對(duì)應(yīng)的控制系統(tǒng)M 文件。
在MATLAB 中導(dǎo)入上文得到的控制參數(shù)M 文件,即Controlspid.m 文件,并通過(guò)Adams _ sys 命令,就能得到所需要的后視鏡機(jī)械控制系統(tǒng)仿真模塊,如圖5 所示。其中,聯(lián)合仿真所需要的是Adams_sub 模塊,其他2 個(gè)模塊分別是機(jī)構(gòu)模型的非線(xiàn)性與線(xiàn)性模型。
圖5 后視鏡機(jī)械機(jī)構(gòu)控制系統(tǒng)仿真模塊Fig.5 Control system simulation module of rearview mirror mechanism
接著按照控制系統(tǒng)總體框架圖,在Simulink中利用各模塊建立如圖6 所示的控制系統(tǒng)模型。其中,系統(tǒng)的輸入是之前設(shè)定的電機(jī)理想轉(zhuǎn)速,經(jīng)過(guò)一個(gè)比例處理模塊后轉(zhuǎn)換成相應(yīng)的殼體目標(biāo)轉(zhuǎn)速,該值通過(guò)累加器與反饋的實(shí)際仿真殼體轉(zhuǎn)速對(duì)比、求差送PID 控制器,PID 經(jīng)過(guò)處理發(fā)出一個(gè)控制轉(zhuǎn)速給ADAMS 模型,達(dá)到調(diào)節(jié)控制作用[12]。
圖6 PID 控制系統(tǒng)模型Fig.6 Model of PID control system
PID 控制參數(shù)調(diào)試包括控制系統(tǒng)對(duì)階躍輸入的響應(yīng)、對(duì)理想設(shè)定輸入的響應(yīng)和調(diào)節(jié)。PID 三個(gè)環(huán)節(jié)參數(shù)調(diào)節(jié)順序,先調(diào)比例后積分,最后調(diào)微分;系數(shù)從小往大的方向變化調(diào)節(jié)。先給控制系統(tǒng)一個(gè)常量輸入,觀察控制系統(tǒng)模型對(duì)階躍輸入的響應(yīng),確定各環(huán)節(jié)大概范圍,最后觀察系統(tǒng)對(duì)給定設(shè)計(jì)輸入的響應(yīng)效果。在這個(gè)過(guò)程中根據(jù)仿真結(jié)果,對(duì)比修改各環(huán)節(jié)參數(shù),實(shí)現(xiàn)控制系統(tǒng)的最佳反饋控制。
控制系統(tǒng)對(duì)階躍輸入的響應(yīng)方面,考慮到殼體轉(zhuǎn)速的波動(dòng),選擇的數(shù)值比設(shè)計(jì)的殼體平均轉(zhuǎn)速稍大一點(diǎn)的值22.9°。對(duì)系統(tǒng)比例系數(shù)KP分別取1 000,1 200,1 500,1 700,進(jìn)行控制系統(tǒng)調(diào)節(jié)仿真對(duì)比。仿真時(shí)間為2.6 s。仿真之后得到的殼體速度仿真結(jié)果如圖7—圖10 所示。
圖7 比例系數(shù)KP=1 000 調(diào)節(jié)仿真結(jié)果Fig.7 Simulation with scale factor of KP=1 000
圖8 比例系數(shù)KP=1 200 調(diào)節(jié)仿真結(jié)果Fig.8 Simulation with scale factor of KP=1 200
系統(tǒng)比例系數(shù)KP調(diào)到1 000 時(shí),局部有轉(zhuǎn)速突變,穩(wěn)態(tài)誤差非常之大;調(diào)到1 200 時(shí),穩(wěn)態(tài)誤差依然較大,轉(zhuǎn)速局部開(kāi)始有突變;繼續(xù)增大比例系數(shù)后,穩(wěn)態(tài)誤差又有小幅減小,局部突變幅度稍有增強(qiáng);調(diào)到1 500 時(shí)穩(wěn)態(tài)誤差相對(duì)較?。划?dāng)超過(guò)1 600 時(shí),系統(tǒng)超調(diào)量開(kāi)始變大;超過(guò)1 700 時(shí)控制系統(tǒng)開(kāi)始發(fā)散,變得不穩(wěn)定。最后選定系統(tǒng)的比例環(huán)節(jié)系數(shù)大致范圍為1 000~1500。
圖9 比例系數(shù)KP=1 500 調(diào)節(jié)仿真結(jié)果Fig.9 Simulation with scale factor of KP=1 500
圖10 比例系數(shù)KP=1 700 調(diào)節(jié)仿真結(jié)果Fig.10 Simulation with scale factor of KP=1 700
確定比例系數(shù)范圍之后,調(diào)試積分系數(shù),將比例系數(shù)KP設(shè)置為1 500,積分系數(shù)Ti分別取10,3 000,30 000,50 000,參見(jiàn)圖11—圖14。
圖11 Ti=10 積分系數(shù)調(diào)節(jié)仿真結(jié)果Fig.11 Simulation with integral coefficient of Ti=10
對(duì)控制系統(tǒng)積分系數(shù)調(diào)節(jié)后的仿真結(jié)果進(jìn)行分析,積分系數(shù)過(guò)小時(shí),積分效果過(guò)強(qiáng),效果不能令人滿(mǎn)意;隨著積分系數(shù)增大,仿真效果越來(lái)越好,當(dāng)積分系數(shù)超過(guò)30 000 后,積分效果減弱過(guò)多,效果又變差。故初步確定PID 控制器的積分時(shí)間Ti范圍在30 000 附近。同時(shí),考慮到后視鏡機(jī)構(gòu)在實(shí)際使用中會(huì)受到許多外界干擾,而微分環(huán)節(jié)對(duì)環(huán)境的干擾比較大,所以控制系統(tǒng)中不采用微分環(huán)節(jié),將微分系數(shù)Td設(shè)為0。
對(duì)理想設(shè)定輸入的響應(yīng)和調(diào)節(jié),在實(shí)際中控制系統(tǒng)要控制的是后視鏡機(jī)構(gòu)的折疊電機(jī),電機(jī)啟動(dòng)時(shí),不能立刻加載大電壓,一是出于過(guò)流保護(hù)的考慮,二是如果啟動(dòng)加速度過(guò)大,將導(dǎo)致慣性力過(guò)大,傳動(dòng)系會(huì)產(chǎn)生較大沖擊,傳動(dòng)件可能受損,甚至燒壞電機(jī)。
圖12 Ti=3 000 積分系數(shù)調(diào)節(jié)仿真結(jié)果Fig.12 Simulation with integral coefficient of Ti=3 000
圖13 Ti=30 000 積分系數(shù)調(diào)節(jié)仿真結(jié)果Fig.13 Simulation with integral coefficient of Ti=30 000
圖14 Ti=50 000 積分系數(shù)調(diào)節(jié)仿真結(jié)果Fig.14 Simulation with integral coefficient of Ti=50 000
選定折疊運(yùn)動(dòng)的總時(shí)間為2.6 s,對(duì)于加速時(shí)間,經(jīng)過(guò)對(duì)大量產(chǎn)品的數(shù)據(jù)統(tǒng)計(jì),設(shè)定0.1,0.2,0.3 s 3 種方案進(jìn)行優(yōu)化對(duì)比。通過(guò)仿真數(shù)據(jù)結(jié)果統(tǒng)計(jì),得到3 種方案下電機(jī)力矩平均有效值分別為41.06,26.97,54.94 N·mm。取力矩最小的方案作為最終選擇,即加速時(shí)長(zhǎng)設(shè)定為0.2 s。最后,得出電機(jī)的理想目標(biāo)速度曲線(xiàn),如圖15 所示。
圖15 電機(jī)目標(biāo)轉(zhuǎn)速輸入曲線(xiàn)Fig.15 Input curve of motor target speed
后視鏡殼體理想目標(biāo)轉(zhuǎn)角曲線(xiàn)如圖16 所示。在沒(méi)有PID 反饋控制的情況下,模型對(duì)理想設(shè)計(jì)輸入的跟隨結(jié)果如圖17 所示,可以看出,后視鏡系統(tǒng)本身傳動(dòng)可靠,但啟動(dòng)有滯后,且無(wú)法控制局部的運(yùn)動(dòng)沖擊。
圖16 后視鏡殼體目標(biāo)轉(zhuǎn)角曲線(xiàn)Fig.16 Target angle curve of rearview miroor shell
圖17 開(kāi)環(huán)控制運(yùn)動(dòng)仿真結(jié)果Fig.17 Open loop control simulation of motion
經(jīng)過(guò)前面系統(tǒng)對(duì)階躍輸入的控制參數(shù)調(diào)節(jié)工作,得出所設(shè)計(jì)的后視鏡控制系統(tǒng)中PID 模塊KP在1 100~1 500,Ti在20 000~30 000 時(shí),控制效果相對(duì)較好。為了進(jìn)一步確定控制參數(shù)的最佳值,將上文設(shè)定的理想電機(jī)轉(zhuǎn)速作為控制系統(tǒng)的輸入,按照傳動(dòng)比得出相應(yīng)的殼體理想輸出轉(zhuǎn)速,對(duì)比理想輸出與仿真結(jié)果,以便觀察,再調(diào)試積分系數(shù)。
對(duì)于設(shè)計(jì)的給定理想輸入,將PID 控制器的比例系數(shù)設(shè)定為1 500,積分時(shí)間設(shè)定為30 000,最后得出控制系統(tǒng)輸出調(diào)試最終結(jié)果,如圖18 所示??梢钥闯觯刂葡到y(tǒng)的響應(yīng)速度比較快,但是超調(diào)量大,因此把控制系統(tǒng)的比例系數(shù)KP降低到1 300,得到圖19 所示的仿真結(jié)果。超調(diào)量降低,響應(yīng)速度也沒(méi)有明顯的降低,但局部的突變依然明顯,歸根到底還是比例作用過(guò)強(qiáng),因此進(jìn)一步將控制系統(tǒng)的比例系數(shù)KP降低。當(dāng)比例系數(shù)降到1 100時(shí),得到的仿真結(jié)果如圖20 所示??梢钥吹?,響應(yīng)速度快,超調(diào)量也小。如圖21 所示,將積分系數(shù)Ti下調(diào)到25 000 時(shí),積分作用開(kāi)始變得過(guò)強(qiáng),轉(zhuǎn)速局部開(kāi)始突變和超調(diào)。總結(jié)控制系統(tǒng)輸出調(diào)試最終結(jié)果可知,圖20 調(diào)試結(jié)果較理想,可以作為控制系統(tǒng)的模型參數(shù)。
圖18 KP=1 500,Ti=30 000 控制系統(tǒng)輸出調(diào)試結(jié)果Fig.18 KP=1 500,Ti=30 000 commissioning results
圖19 KP=1 300,Ti=30 000 控制系統(tǒng)輸出調(diào)試結(jié)果Fig.19 KP=1300,Ti=30 000 commissioning results
圖20 KP =1 100 Ti=30 000 控制系統(tǒng)輸出調(diào)試結(jié)果Fig.20 KP=1 100,Ti=30 000 commissioning results
圖21 KP=1 100,Ti=25 000 控制系統(tǒng)輸出調(diào)試結(jié)果Fig.21 KP=1 100,Ti=25 000 commissioning results
如圖22 所示,后視鏡模型轉(zhuǎn)過(guò)的總角度為54.3°,跟目標(biāo)轉(zhuǎn)角曲線(xiàn)對(duì)比,上方曲線(xiàn)為轉(zhuǎn)過(guò)角度的目標(biāo)曲線(xiàn),下方曲線(xiàn)為機(jī)構(gòu)仿真轉(zhuǎn)過(guò)的角度。對(duì)比設(shè)計(jì)的總轉(zhuǎn)角55°,誤差1.27%,所以控制系統(tǒng)整體的控制效果令人滿(mǎn)意。
圖22 后視鏡轉(zhuǎn)角輸出仿真結(jié)果Fig.22 Simulation of rearview mirror angle output
對(duì)比以上仿真結(jié)果,最終確定控制系統(tǒng)的PID控制器的比例環(huán)節(jié)和積分環(huán)節(jié)的系數(shù)分別為1 100和30 000,并證明了PID 控制系統(tǒng)對(duì)修正后視鏡機(jī)構(gòu)運(yùn)動(dòng)誤差的有效性。
本后視鏡折疊控制系統(tǒng),首先取代了傳統(tǒng)的折疊限位機(jī)構(gòu),在滿(mǎn)足折疊功能的前提下,減小了折疊系統(tǒng)轉(zhuǎn)動(dòng)慣量;其次,基于ADAMS 與MATLAB對(duì)電動(dòng)折疊器進(jìn)行了PID 聯(lián)合仿真控制。對(duì)控制器控制參數(shù)優(yōu)化結(jié)果是:控制系統(tǒng)的PID 控制器比例和積分環(huán)節(jié)的系數(shù)分別為1 100 和30 000,此時(shí)穩(wěn)態(tài)誤差小,響應(yīng)速度快,超調(diào)量也小,同時(shí)后視鏡轉(zhuǎn)角輸出仿真結(jié)果誤差小,控制效果令人滿(mǎn)意。