兩輪電動(dòng)平衡車(chē)系統電路設計詳解 —電路圖天天讀(174)
在國外,兩輪載人平衡車(chē)早已被用于一些公共場(chǎng)合了,如今很多機場(chǎng)、火車(chē)站、汽車(chē)站等公共場(chǎng)所都運用了兩輪載人平衡車(chē)。研究?jì)奢喥胶廛?chē)小車(chē)有利于研究?jì)奢嗇d人平衡車(chē)。本作品主要由一塊IAP15F2K61S2單片機開(kāi)發(fā)板做主控板,一個(gè)電源和傳感器模塊來(lái)采集角度數據并為系統供電,一個(gè)測速模塊來(lái)測得電機的速度信息,最后把角度信息轉化成PWM輸出給一個(gè)電機驅動(dòng)模塊來(lái)控制兩個(gè)空心杯電機。
本文引用地址:http://dyxdggzs.com/article/201710/369111.htm本設計是基于IAP15F2K61S2單片機系統開(kāi)發(fā)的兩輪平衡車(chē),采用IAP15F2K61S2單片機開(kāi)發(fā)板做主控板,用MPU6050 陀螺儀和加速度傳感器采集加速度和角速度,通過(guò)計算得出角度以確定小車(chē)姿態(tài),再通過(guò)光電門(mén)傳感器測出小車(chē)電機轉速,以計算出車(chē)速,運用PID算法再根據傳感器測得數據處理后對電機驅動(dòng)進(jìn)行PWM輸出,調節合適的PID參數使小車(chē)能穩定直立起來(lái)。
本作品使用簡(jiǎn)單,打開(kāi)總開(kāi)關(guān)小車(chē)即可直立。兩輪載人平衡車(chē)在一些公共場(chǎng)合有一定的優(yōu)勢,研究?jì)奢喥胶庑≤?chē)對開(kāi)發(fā)兩輪載人平衡車(chē)有一定的幫助,本作品具有結構簡(jiǎn)單清晰,使用方便等特點(diǎn)。
設計特色:
小車(chē)底盤(pán)是我們用游標卡尺量出電機支架的孔徑和位置,用Altium Designer 軟件畫(huà)出底盤(pán)模型,再用雕刻機和亞克力板雕刻出底盤(pán)。車(chē)上面傳感器模塊和電池盒的安裝具有對稱(chēng)性,使小車(chē)重心在電機上方,傳感器安裝比電機稍微高點(diǎn),大概在重心處,這樣有助于小車(chē)的平衡和穩定性。在算法上我們采用精簡(jiǎn)PID算法和卡爾曼濾波算法來(lái)控制電機,使系統更穩定可靠。
平臺選型說(shuō)明:
本系統采用IAP15F2K61S2單片機開(kāi)發(fā)板做主控板,IAP15F2K60S2是1T的8051單片機。是真正意義上的單片微機,寬工作電壓,不 需要外部復位電路和外部晶振,內部晶振5—33.1776M可選。片上外設豐富,具有3通道捕獲比較單元(CCP/PCA/PWM),8通道10位高速 AD,3個(gè)定時(shí)器/計數器,雙串口,高速串行通信ISP接口,大容量片內EEPROM。電機驅動(dòng)采用LM298N,測速采用透射式光電門(mén),信號經(jīng)反向器輸 出穩定脈沖,電機采用空心杯,頻率可達十幾千赫茲。
更多無(wú)人機系統MCU資料,詳情請進(jìn)入》》》
IAP15F2K61S2單片機開(kāi)發(fā)板原理圖
本作品用到IAP15F2K61S2單片機的內部資源有定時(shí)器1、定時(shí)器2、串口1、ADC、外部中斷0、外部中斷1、PWM等這些資源。定時(shí)器1以10ms的周期處理數據,定時(shí)器2作為串口1的波特率發(fā)生器,串口1用于調試時(shí)與上位機軟件通訊,ADC是采集電位器可調端的電壓用于調試 PID參數,外部中斷0、1用于計數測速模塊的脈沖,PWM作為使能電機驅動(dòng)輸入信號。
MPU6050模塊和電源模塊原理圖
MPU6050采用IIC通訊傳輸數據,電源模塊采用LM7805($0.2053)做穩壓芯片給單片機和傳感器供電。
測速和電機轉接模塊
每個(gè)電機尾部都有兩個(gè)光電門(mén)用以測速,光電門(mén)輸出信號經(jīng)反向器輸出后更穩定可靠。電機接線(xiàn)用轉接板轉接有利于保護電機接線(xiàn)。
keep out層畫(huà)邊框、頂層畫(huà)輔助線(xiàn),用雕刻機先打孔再割邊。
設計說(shuō)明:
本設計在IAP15F2K61S2單片機開(kāi)發(fā)板的基礎上,利用陀螺儀和加速度傳感器以周期為10ms測出角度信息,經(jīng)卡爾曼濾波算法濾波處理后再經(jīng)PD算法處理輸出,測速模塊以周期為100ms測出速度信息,在經(jīng)互補濾波算法濾波后再經(jīng)PI算法處理輸出,將角度環(huán)的輸出量與速度環(huán)的輸出量融合作為PWM的設定值對電機驅動(dòng)輸入從而控制電機。
評論