基于Kinetis K60的智能平衡車控制系統(tǒng)設(shè)計

伍小平++曹思宇

摘 要文章旨在設(shè)計并實現(xiàn)基于飛思卡爾Kinetis K6032位微控制器的一種可以實現(xiàn)電磁導(dǎo)航的智能平衡車控制系統(tǒng)。詳細分析了系統(tǒng)動力學(xué)模型，介紹了各硬件模塊及其軟件控制算法。最后通過系統(tǒng)綜合測試，車模在自平衡的姿態(tài)下能夠快速、平穩(wěn)地通過各種路徑。

【關(guān)鍵詞】飛思卡爾 智能車 電磁導(dǎo)航 自平衡

雙輪直立行駛電磁平衡車作為導(dǎo)航車的一種形式，是由動力學(xué)理論、自動控制理論與實際研究相結(jié)合的一種先進技術(shù)，不僅能夠在自動循跡倉儲物流、執(zhí)勤巡邏、基地訓(xùn)練等方面作為短距離代步工具，而且可以在醫(yī)療緊急救援、穿越狹窄道路搶險以及軍事偵查與運輸供給等方面進行應(yīng)用。在教育部承辦的大學(xué)生智能車競賽的背景下，本文的智能平衡車控制系統(tǒng)能夠?qū)崿F(xiàn)在寬度為45CM，中間鋪設(shè)引導(dǎo)線即一根通有20KHz交流電銅線的賽道上，以兩輪自平衡的姿態(tài)自動識別路徑、控制車體行進速度和方向。

1 智能平衡車整體控制策略

控制系統(tǒng)總共包括5大模塊：電源管理模塊、姿態(tài)傳感模塊、測速傳感模塊、路徑識別模塊和電機驅(qū)動模塊。

如圖1所示，單片機通過采集陀螺儀和加速度計的輸出信號，經(jīng)過軟件互補濾波后獲得智能車的當前姿態(tài)，計算得到角度偏差。通過AD采集電磁傳感模塊的模擬量輸出信號，計算得到位置偏差。通過正交解碼獲取測速傳感模塊的兩輪速度信號，計算得到速度偏差。最終進行各閉環(huán)的PID調(diào)節(jié)并融合電機PWM輸出。同時為了實時對智能車進行監(jiān)控，系統(tǒng)引入了藍牙模塊，在車模實際運行中持續(xù)發(fā)送數(shù)據(jù)，通過上位機顯示，獲取車模的實時姿態(tài)方便參數(shù)調(diào)試。

2 智能平衡車模型建立

通過分析平衡車的動力學(xué)特征，可以獲得系統(tǒng)在平衡瞬間的力學(xué)方程，平衡車主體部分由中間類似倒立擺的車體和兩側(cè)的車輪構(gòu)成，依靠電機施加在左右輪軸上的力矩維持平衡。對車體進行簡化得到如圖2所示的模型。

假設(shè)平衡車為一剛體，左右兩輪對稱分布，并且不考慮車輪與地面的打滑情況，對左輪進行受力分析得平衡方程：

其中，ml：左輪質(zhì)量（kg）；xL：左輪相對地面的位移（m）；fL：地面提供左輪的摩擦力（N）；HL：車身作用于左輪的水平作用力（N）；JL：左輪轉(zhuǎn)動慣量（kgm2）；uL：左輪旋轉(zhuǎn)角度（rad）；CL：左輪轉(zhuǎn)矩（N·m）；R：輪子半徑（m）。

類似左輪，得右輪平衡方程：

假設(shè)：ml=mr=m1，JL=JR=J1

對車體在YoZ平面上擺動瞬間進行受力分析，得水平方向平衡方程：

其中，m0：車體質(zhì)量（kg）；xx：車體水平方向位移（m）；x0：車輪平均位移（m）；H：車體重心與車輪軸心距離（m）；θ：車體垂直方向偏轉(zhuǎn)角度（rad）。

垂直方向平衡方程

其中，xz：車體垂直方向位移（m）；VL：車體作用于左輪的垂直作用力（N）；VR：車體作用于右輪的垂直作用力（N）。

其中，J0：車體（倒立擺）轉(zhuǎn)動慣量（kgm2）。

對車模在XoY平面轉(zhuǎn)動時進行分析，得平衡方程：

其中，J2：整個車身轉(zhuǎn)動慣量（kgm2）；ω：車體水平方向偏轉(zhuǎn)角度（rad）；L：兩個車輪軸心間距離（m）。

當θ角度很小時，令sinθ=θ，cosθ=1，并忽略高次項，最終得到系統(tǒng)數(shù)學(xué)模型：

3 智能平衡車硬件電路設(shè)計

3.1 電源管理模塊

系統(tǒng)的電力來源于一塊7.2V、2A/h的鎳鎘電池，為了在保證整個系統(tǒng)穩(wěn)定運行的基礎(chǔ)上盡可能地減小電源模塊之間的干擾，采用以下電源管理策略：

（1）為了降低電源電路復(fù)雜度，統(tǒng)一使用5V供電。選用LDO低壓差線性穩(wěn)壓器TPS76850。

（2）電機模塊單獨供電。MCU等模塊能夠長時間處于穩(wěn)定工作狀態(tài)，相互之間干擾較小，而電機模塊驅(qū)動電機時電池會發(fā)生較大的壓降和電流，容易產(chǎn)生對其它模塊的干擾。

3.2 姿態(tài)傳感模塊

智能平衡車控制系統(tǒng)的核心在于對車模平衡狀態(tài)的控制，為維持車模平衡需要實時監(jiān)控車模在X軸和Z軸的姿態(tài)。姿態(tài)傳感包括MMA8451加速度計和MPU3050陀螺儀兩個部分。均為數(shù)字型傳感器，具有穩(wěn)定、靈敏度高以及零溫漂等特點。

3.3 測速傳感模塊

系統(tǒng)使用兩個512線3相增量式Mini編碼器分別采集車模左右兩輪的速度及其方向。該編碼器體積小、質(zhì)量輕、信號采集速度快，完全能夠滿足系統(tǒng)快速進行速度控制的要求。

3.4 路徑識別模塊

選用10mH工型電感作為電磁感應(yīng)線圈，再并聯(lián)6.8nF電容構(gòu)成RLC并聯(lián)諧振檢波電路，實現(xiàn)道路電磁中心線的檢測。由于采集到的正弦信號的振幅較小且衰減速度很快，不便于MCU的AD采集，所以選用一款單電源反饋型雙核放大器AD8032進行信號的放大工作。

3.5 電機驅(qū)動模塊

電機驅(qū)動模塊采用全橋電路，由HIP4082驅(qū)動4片N型LR7843 MOS管構(gòu)成，用MC34063提供12V升壓供電。LR7843具有極低的導(dǎo)通電阻與柵極阻抗，額定工作電流可輕松達到100A以上，有利于響應(yīng)快速變化的PWM。

4 智能平衡車系統(tǒng)軟件設(shè)計

4.1 系統(tǒng)工作流程

系統(tǒng)的軟件設(shè)計工作是在IAR 7.4平臺上完成的，使用C語言編寫控制代碼。系統(tǒng)的軟件算法控制流程圖如圖3所示。主要實現(xiàn)功能：各傳感器模塊的初始化；車模姿態(tài)和速度的采集；車模運行時的控制（包括方向環(huán)、速度環(huán)、方向環(huán)，其中方向環(huán)和速度環(huán)采用串級控制，速度環(huán)為內(nèi)環(huán)，方向環(huán)為外環(huán)）；電機PWM占空比的輸出；車模的啟動與停車控制；串口監(jiān)控數(shù)據(jù)的發(fā)送。

4.2 直立環(huán)設(shè)計

直立環(huán)負責(zé)車模平衡狀態(tài)的維持，需要獲取車模實時的姿態(tài)信息。經(jīng)過零偏量矯正與比例化處理后，在較短時間內(nèi)，陀螺儀能夠動態(tài)地反映角度變化，在較長時間內(nèi)，加速度計能夠靜態(tài)地反映角度變化，因此加速度計需要低通濾波，陀螺儀需要高通濾波。采用互補濾波算法將角度與角速率進行數(shù)據(jù)融合：

式中，、分別為t0、t1時刻融合角度；為t1時刻角速率；dt為積分周期；k為加速度計權(quán)重；為t1時刻角度。

互補濾波算法提高了角度在動態(tài)環(huán)境下的檢測精度，使用濾波后的角度和角速率值，采用PD控制策略即可取得較好的直立控制效果：

式中，PMWb為直立環(huán)PWM輸出；為t1時刻動態(tài)平衡點角度值；kbp、kbd分別為直立環(huán)比例、積分參數(shù)。

4.3 速度環(huán)設(shè)計

編碼器的脈沖進行正交解碼便能得出雙輪的速度與方向，經(jīng)過軟件低通濾波后便可用于速度控制。直立環(huán)和速度環(huán)采用串級控制，其中速度環(huán)控制使用增量式PID策略：

式中，ksp、ksi、ksd分別為速度環(huán)比例、積分、微分參數(shù)；e[t0]、e[t1]、e[t2]分別為t0、t1、t2時刻速度誤差值；作為外環(huán)輸出。

4.4 轉(zhuǎn)向環(huán)設(shè)計

平衡車在行駛過程中電感與地面的垂直距離容易發(fā)生改變，使用差比和方案消除高度改變引起的誤差，并引入斜電感增加其預(yù)判能力：

式中，為t1時刻擬合偏差值；AD0、AD1分別為左右電感值。

轉(zhuǎn)向環(huán)使用PD控制策略，并引入轉(zhuǎn)向陀螺儀增加車模轉(zhuǎn)向穩(wěn)定性：

式中，PWMd為轉(zhuǎn)向環(huán)PWM輸出；、分別為t0、t1時刻方向偏差值；kdp、kdd分別為轉(zhuǎn)向環(huán)比例、微分參數(shù)；kdg為轉(zhuǎn)向陀螺儀微分參數(shù)，為了抑制轉(zhuǎn)向環(huán)過沖現(xiàn)象，所以極性為負。

5 結(jié)束語

本文對智能車模型建立、硬件設(shè)計、軟件設(shè)計三方面進行了分析，按照以上方案進行最終形成了一個完整的智能平衡車控制系統(tǒng)，各模塊穩(wěn)定運行，并通過了真實賽道的測試，車模在直立、方向、速度三個方面均控制平穩(wěn)。

參考文獻

[1]羅衛(wèi)軍，羅勃，曾祎等.基于磁場檢測的自平衡巡線智能小車設(shè)計[J].電子設(shè)計工程，2013（13）：114-116.

[2]薛凡，孫京誥，嚴懷成.兩輪平衡車的建模與控制研究[J].化工自動化及儀表，2012（11）：1450-1454.

[3]周立，周震.基于電磁引導(dǎo)的智能車電控系統(tǒng)設(shè)計[J].煤礦機電，2012（01）：81-84.

[4]張昊飏，馬旭，卓晴.基于電磁場檢測的尋線智能車設(shè)計[J].電子產(chǎn)品世界，2009（11）：48-50.

[5]曹楠，劉益劍，任仁凱等.基于線陣CCD的兩輪自平衡智能車系統(tǒng)[J].自動化應(yīng)用，2015（03）：65-67.

作者簡介

伍小平（1995-），男，安徽省桐城市人?，F(xiàn)安徽財經(jīng)大學(xué)管理科學(xué)與工程學(xué)院計算機科學(xué)與技術(shù)專業(yè)在讀本科生。研究方向為嵌入式軟件與系統(tǒng)。

曹思宇（1995-），女，安徽省六安市人?，F(xiàn)安徽財經(jīng)大學(xué)管理科學(xué)與工程學(xué)院電子信息工程專業(yè)在讀本科生。研究方向為通信工程。

作者單位

安徽財經(jīng)大學(xué)管理科學(xué)與工程學(xué)院 安徽省蚌埠市 233030