馬立華
(太原科技大學(xué),山西 太原 030024)
隨著科學(xué)技術(shù)水平的不斷進步,交通工具正朝著小型、節(jié)能、環(huán)保的方向發(fā)展,“電動車”正是在這個背景下孕育而生并為人們所熟識。據(jù)不完全統(tǒng)計,我國的電動車保有量已超過1.2 億輛,是增長速度最快的交通工具。隨著石油儲量的不斷減少和人們環(huán)保意識的增強,“電動車”無疑將成為未來交通工具的主力軍。就目前而言,電動車的種類主要有電動自行車、電動摩托車和電動汽車。由于電動機制造水平的提高,尤其是大功率直流無刷電動機制造工藝的成熟,帶動了電動自行車和電動摩托車行業(yè)的飛速發(fā)展。同時,人們也根據(jù)兩輪自平衡機器人工作原理,設(shè)計出了一些新式電動車——兩輪自平衡電動車。它是一種新型的交通工具,它一改電動自行車和摩托車車輪前后排列方式,而是采用兩輪并排固定的方式,這種結(jié)構(gòu)將給人們帶來一種全新的駕馭感受。兩輪自平衡電動車僅靠兩個輪子支撐車體,采用蓄電池提供動力,由電動機驅(qū)動,采用微處理器、姿態(tài)感知系統(tǒng)、控制算法及車體機械裝置共同協(xié)調(diào)控制車體的平衡,僅靠人體重心的改變便可以實現(xiàn)車輛的啟動、加速、減速、停止等功能。
兩輪自平衡車主要是綠色環(huán)保。電動車使用電池作為動力能源,并可以反復(fù)充電使用,大大減少了對環(huán)境的污染。轉(zhuǎn)彎半徑為零,在小空間范圍內(nèi)可以靈活運動。無剎車系統(tǒng),由CPU 自動給出正反轉(zhuǎn)力矩,從而達到快速穩(wěn)定的剎車效果。
控制極其方便,前進后退自如。兩輪自平衡電動車是一個高度不穩(wěn)定的系統(tǒng),其動力學(xué)方程是一多變量、嚴重不穩(wěn)定、耦合、時變、參數(shù)不確定性的非線性高階方程,加上運動學(xué)方程中的非完整性約束,要求完成的控制任務(wù)也具有多重性,因此,兩輪自平衡電動車作為一個具體的復(fù)雜系統(tǒng),給控制理論提出了很大的挑戰(zhàn),是檢驗各種控制方法處理能力的典型裝置。兩輪自平衡電動車作為一種研究裝置,可進行不確定性系統(tǒng)控制、非線性系統(tǒng)控制、自適應(yīng)控制、智能控制等研究。
兩輪自平衡自動車采用AVR Atmega16 芯片作為主控制芯片[1],選擇外部16 MHz 晶振,使用JTAG 仿真器進行實時仿真與調(diào)試;采用LCD1602 顯示轉(zhuǎn)彎角度傳感器測量的動態(tài)角度和角速度,為了讓調(diào)試的過程中更加直觀。動態(tài)角度和角速度的測量通過陀螺儀測量角速度,三軸加速度計測量角度。由于平衡車是運動的,所以三軸加速度計測量的角度里面參雜動態(tài)角度,最終通過卡爾曼硬件融合電路精確地測量出動態(tài)的角度和角速度。轉(zhuǎn)向模塊采用高精度電位器,當手把向右偏轉(zhuǎn)時,兩輪車向右轉(zhuǎn),當手把向左偏轉(zhuǎn)時兩輪自平衡車向左轉(zhuǎn)彎,可以實現(xiàn)原地轉(zhuǎn)彎。電機采用直流減速電機,主要是因為直流減速電機能耗低、性能優(yōu)越、減速機效率高達95%以上,而且振動小、噪音低、節(jié)能高、選用優(yōu)質(zhì)段鋼材料,鋼性鑄鐵箱體,齒輪表面經(jīng)過高頻熱處理。節(jié)省空間,可靠耐用,承受過載能力高,經(jīng)過精密加工,確保定位精度,扭矩大。電機驅(qū)動模塊采用大功率MOS 管,由于電機的功率大,需要的電流大。電機的轉(zhuǎn)動通過PID 控制算法[2],實現(xiàn)兩輪車的自平衡狀態(tài)。系統(tǒng)簡易硬件結(jié)構(gòu)框圖如圖1所示。
圖1 系統(tǒng)簡易硬件結(jié)構(gòu)框圖
兩輪自平衡車的直立是通過負反饋來實現(xiàn)的,但是兩輪自平衡車的直立相對木棒的直立是相對簡單的,木棒的直立是二維的而自平衡車有兩個輪子著地且直立是一維的。所以通過控制輪子的轉(zhuǎn)動,抵消傾斜的趨勢便可以很好地保持車體直立。兩輪自平衡車模型如圖2 所示。
圖2 兩輪自平衡車模型圖
兩輪自平衡車之所以在不加外力的情況下不能夠直立,是因為車體的偏轉(zhuǎn)方向和受力方向是在同一方向,所以車體會加速倒下,如果要車體直立不倒下那就需要添加外力作用才能夠保持平衡狀態(tài),這個外力就是車輪對地的摩擦力。由于電機在轉(zhuǎn)動時給地面一個摩擦力,根據(jù)牛頓第三定律,地面給車體一個與相對運動方向相反的作用力,這樣才會不至于讓車體加速倒下。
兩輪自平衡車的受力分析[3]:
圖3 受力分析圖
車體所受的回復(fù)力為:
式中由于α 很小,所以:
由于現(xiàn)實中存在空氣阻力和摩擦力等阻尼力,所以:
因此控制車輪加速的數(shù)學(xué)模型為:
兩輪自平衡車的速度是通過車輪的速度實現(xiàn)的。車輪的速度通過直流電機經(jīng)過減速箱,增大扭矩。利用直流電機驅(qū)動器控制電機的正反轉(zhuǎn)和PWM 調(diào)速系統(tǒng)控制兩輪自平衡車的平穩(wěn)運行。然后通過電機的加速度控制車體的平衡,通過電機的恒定速度和靜止狀態(tài)控制車體的勻速運動和靜止狀態(tài)。
在運行的過程中當人體的傾角增大時車輪的加速隨之增大以控制車體的平衡,當車體恢復(fù)平衡時,以恒定的速度勻速前進。
當轉(zhuǎn)把轉(zhuǎn)動時可實現(xiàn)自動復(fù)位功能,在轉(zhuǎn)把的軸徑方向安裝一個大強度的彈簧,使轉(zhuǎn)把在轉(zhuǎn)動的過程中自動恢復(fù)原位,實現(xiàn)了靈活轉(zhuǎn)彎的效果,如果轉(zhuǎn)把的偏向角足夠大可以實現(xiàn)原地轉(zhuǎn)彎,使兩輪車的運行更加靈活,方便在狹小的地方使用。轉(zhuǎn)把示意圖如圖4 所示。
圖4 轉(zhuǎn)把示意圖
轉(zhuǎn)把的方向和偏向角是通過高精度電位器檢測的,在轉(zhuǎn)把的固定軸上安裝個角度傳感器,實現(xiàn)角度的測量。
為了便于程序的開發(fā)和以后的使用與維護,全部程序采用模塊化結(jié)構(gòu),即由一個主程序和若干個子程序模塊構(gòu)成。主程序首先完成初始化工作,包括定時器初始化、LCD1602液晶模塊初始化、定時器中斷初始化、系統(tǒng)時鐘初始化、其他參數(shù)的初始化等。然后啟動定時器進行定時,開中斷允許單片機響應(yīng)內(nèi)部中斷請求。定時器中斷流程圖如圖6 所示。各程序功能模塊包括LCD1602 液晶顯示、電機驅(qū)動、動態(tài)角度測量、轉(zhuǎn)向、欠壓報警等。主程序流程圖如圖5 所示。
圖5 程序主流程圖
圖6 定時器中斷流程圖
整個系統(tǒng)軟件采用模塊化結(jié)構(gòu)。軟件系統(tǒng)包括:主程序負責(zé)顯示。車體直立模塊用定時器1 中斷完成,每進入一次中斷完成一次PID 算法控制車體平衡,在車體保持平衡狀態(tài)的情況下通過采集轉(zhuǎn)把數(shù)據(jù)實現(xiàn)轉(zhuǎn)彎功能。
本系統(tǒng)采用ATMEGA16 控制芯片簡化了系統(tǒng)的硬件結(jié)構(gòu),提高了系統(tǒng)的可靠性和實時性。利用MMA7260 和ENC-03MB 可以精確地測量出車體的動態(tài)角度和角速度,采用大功率MOS 管和板橋驅(qū)動芯片可以很好地去除MOS 管的發(fā)熱問題,減少能量的損耗。本電動車采用鋰電池供電既節(jié)能又環(huán)保,本設(shè)計的兩輪自平衡電動車可以在狹小的環(huán)境中行走自如,使出行帶來方便。本系統(tǒng)對實際工程應(yīng)用有一定的指導(dǎo)意義。
[1]馬潮.AVR 單片機嵌入式系統(tǒng)原理與應(yīng)用實踐[M].北京:北京航空航天大學(xué)出版社,2007.
[2]劉金琨.先進PID 控制及其MATLAB 仿真[M].北京:電子工業(yè)出版社,2011.
[3]王紀龍,周希堅.大學(xué)物理[M].北京:科學(xué)出版社,2007.