基于xs128的光電平衡智能車系統設計

嚴起邦+譚峰+張洪來+鄧世楠+王涵+曹新芳

摘 要：文章旨在研制一種自平衡同軸雙輪循跡小車。系統以陀螺儀和加速度計來檢測車身所處的狀態和變化率，通過處理器（16位飛思卡爾單片機MC9S12XS128）計算出適當數據和指令，通過PWM驅動兩個電機產生前進或后退的加速度使車達到保持平衡效果，以線性CCD光電傳感器來識別黑線檢測路徑，闡述了自平衡的原理同時對系統用到的PID控制技術做了相應介紹，從理論上分析了變積分的PID控制技術的優勢，并在系統的實際測試中獲得了良好的效果。

關鍵詞：光電平衡；xs128；智能車

1 引言

隨著智能化的發展，汽車的智能化、自動化是社會發展的必然趨勢。通過項目的研究使兩輪自平衡小車能夠智能的識別道路、加速、轉彎、避障等復雜路況，實現智能駕駛。同時兩輪自平衡小車使得車體更加靈活、減少交通擁堵、停車困難等實際生活問題，對于提高人們的生活水平有實際意義，最終設計小車在規定路徑上實現自動尋跡、智能壁障等功能。

2 平衡車原理

通過對單擺進行受力分析可知，單擺能夠穩定在垂直位置的條件有兩個：受到與位移（角度）相反的恢復力；受到與運動速度相反的阻尼力。控制倒立擺底部車輪，使得它作加速運動。這樣站在小車上看倒立擺，它在受到與車輪加速度大小成正比方向相反的慣性力的影響。 普通的單擺受力分析如圖1所示。

當物體離開垂直的平衡位置之后，便會受到重力與懸線的作用合力，驅動重物回復平衡位置。這個力稱之為回復力，其大小為F=-mgsin？茲≈-mg？茲，在此回復力F作用下，單擺便進行周期運動。在空氣中運動的單擺，由于受到空氣的阻尼力，單擺最終會停止在垂直平衡位置。空氣的阻尼力與單擺運行速度成正比，方向相反。阻尼力越大，單擺越會盡快在垂直位置穩定下來。

這樣倒立擺所受到的回復力為：

式中，假設偏角θ與控制車輪加速度成正比，比例為k1。如果k1>g那回復力與位移的方向相反。另外，增加阻尼力能讓倒立擺盡快回到原位置，阻尼力與偏角的速度成正比，方向相反。因此式（1）可變為：

將倒立擺模型轉換成單擺模型，使擺能夠穩定在豎直位置。從而得到控制平衡車車輪加速度的控制算法

3 系統硬件電路設計

3.1 系統整體設計

硬件整體框圖如圖2所示。智能車由電源模塊、傳感器模塊、電機驅動模塊、單片機最小系統等組成。智能車的工作過程：由線性CCD探測路徑信息，歐姆龍檢測當前車速，將各個傳感器采集來的信息交給處理器處理，通過控制算法得出PWM，來控制電機驅動模塊輸出相應的控制電壓，達到控制平衡、轉向、循跡的功能。

電機驅動電路如圖3所示，采用2片BTN7970組成一個完整的H橋驅動電路驅動l路有刷直流電機，P0、P2端分別接電機的兩端，BTN 1腳端接下拉電阻，PWM1與PWM5分別輸出非零占空比和零占空比的PWM，讓半橋各有一個導通，組成一個回路，電機驅動模塊由橋構成，H橋具有工作電壓范圍大，導通電阻小，導通電流大的優點。

3.2 PID控制原理

連續控制系統中PID控制規律如下：

其中 是偏差信號為零時的控制作用，是控制量的基準；利用外接矩形進行數值微分，當選定采樣周期為T時，式（4）可離散為下面的差分方程

增量式PID算式，

于是：

式（7）的計算結果，得出第k與第k-1次的輸出之間的增量，所以稱為增量算式。利用增量算式來控制執行程序，執行程序每次只增加一個增量，所以執行對象只是起到一個累加的作用。

4 系統軟件設計

MC9S12DG128 微控制單元作為MC9S12系列的16位單片機，由標準片上外圍設備組成，同時，單片機內的鎖相環電路可使能耗和性能適應具體操作的需要。車模主程序框架如圖4所示。

程序上電運行后，便進行單片機的初始化，包括單片機需要用到的資源進行初始化和應用程序初始化。

將車體角度和角速度乘以各自相對應的系數得出直立控制的輸出量。程序算法框圖如圖5所示。

直立控制算法部分代碼如下：

5 結束語

整車在方案設計、硬件搭建、機械結構調整、軟件編程調試、整體開發流程中，每一步都會遇到各種各樣的問題，硬件分模塊屏蔽調試，直到穩定，機械結構理論分析，不同方案試用對比，軟件優化各個控制參數，通過進一步對控制算法的改進提高車模的運行速度，實際測試效果良好。

參考文獻

[1]馮智勇，曾瀚，張力，趙亦欣，黃偉.基于陀螺儀及加速度計信號融合的姿態角度測量[J].西南師范大學學報，2011，36（4）：137-141.

[2]陳靜.兩輪自平衡機器人模型及控制方法研究[D].北京工業大學碩士學位論文，2008.

[3]Rich Chi Ooi.Balancing a Two-Wheeled Autonomous Robot[D].The University of Western Australia Final Year Thesis，2003.

[4]Gene F.Franklin，J.David Powell，Michael L.Workman.Digital Control of Dynamic Systems[M].北京：清華大學出社，2011.

作者簡介：嚴起邦（1990-），男，學生，黑龍江八一農墾大學，現主要從事兩輪平衡車方面研究學習。

通訊作者：譚峰，男，教授，哈爾濱工業大學畢業，現主要從事智能化監控技術的研究工作。endprint

摘 要：文章旨在研制一種自平衡同軸雙輪循跡小車。系統以陀螺儀和加速度計來檢測車身所處的狀態和變化率，通過處理器（16位飛思卡爾單片機MC9S12XS128）計算出適當數據和指令，通過PWM驅動兩個電機產生前進或后退的加速度使車達到保持平衡效果，以線性CCD光電傳感器來識別黑線檢測路徑，闡述了自平衡的原理同時對系統用到的PID控制技術做了相應介紹，從理論上分析了變積分的PID控制技術的優勢，并在系統的實際測試中獲得了良好的效果。

關鍵詞：光電平衡；xs128；智能車

1 引言

隨著智能化的發展，汽車的智能化、自動化是社會發展的必然趨勢。通過項目的研究使兩輪自平衡小車能夠智能的識別道路、加速、轉彎、避障等復雜路況，實現智能駕駛。同時兩輪自平衡小車使得車體更加靈活、減少交通擁堵、停車困難等實際生活問題，對于提高人們的生活水平有實際意義，最終設計小車在規定路徑上實現自動尋跡、智能壁障等功能。

2 平衡車原理

通過對單擺進行受力分析可知，單擺能夠穩定在垂直位置的條件有兩個：受到與位移（角度）相反的恢復力；受到與運動速度相反的阻尼力。控制倒立擺底部車輪，使得它作加速運動。這樣站在小車上看倒立擺，它在受到與車輪加速度大小成正比方向相反的慣性力的影響。 普通的單擺受力分析如圖1所示。

當物體離開垂直的平衡位置之后，便會受到重力與懸線的作用合力，驅動重物回復平衡位置。這個力稱之為回復力，其大小為F=-mgsin？茲≈-mg？茲，在此回復力F作用下，單擺便進行周期運動。在空氣中運動的單擺，由于受到空氣的阻尼力，單擺最終會停止在垂直平衡位置。空氣的阻尼力與單擺運行速度成正比，方向相反。阻尼力越大，單擺越會盡快在垂直位置穩定下來。

這樣倒立擺所受到的回復力為：

式中，假設偏角θ與控制車輪加速度成正比，比例為k1。如果k1>g那回復力與位移的方向相反。另外，增加阻尼力能讓倒立擺盡快回到原位置，阻尼力與偏角的速度成正比，方向相反。因此式（1）可變為：

將倒立擺模型轉換成單擺模型，使擺能夠穩定在豎直位置。從而得到控制平衡車車輪加速度的控制算法

3 系統硬件電路設計

3.1 系統整體設計

硬件整體框圖如圖2所示。智能車由電源模塊、傳感器模塊、電機驅動模塊、單片機最小系統等組成。智能車的工作過程：由線性CCD探測路徑信息，歐姆龍檢測當前車速，將各個傳感器采集來的信息交給處理器處理，通過控制算法得出PWM，來控制電機驅動模塊輸出相應的控制電壓，達到控制平衡、轉向、循跡的功能。

電機驅動電路如圖3所示，采用2片BTN7970組成一個完整的H橋驅動電路驅動l路有刷直流電機，P0、P2端分別接電機的兩端，BTN 1腳端接下拉電阻，PWM1與PWM5分別輸出非零占空比和零占空比的PWM，讓半橋各有一個導通，組成一個回路，電機驅動模塊由橋構成，H橋具有工作電壓范圍大，導通電阻小，導通電流大的優點。

3.2 PID控制原理

連續控制系統中PID控制規律如下：

其中 是偏差信號為零時的控制作用，是控制量的基準；利用外接矩形進行數值微分，當選定采樣周期為T時，式（4）可離散為下面的差分方程

增量式PID算式，

于是：

式（7）的計算結果，得出第k與第k-1次的輸出之間的增量，所以稱為增量算式。利用增量算式來控制執行程序，執行程序每次只增加一個增量，所以執行對象只是起到一個累加的作用。

4 系統軟件設計

MC9S12DG128 微控制單元作為MC9S12系列的16位單片機，由標準片上外圍設備組成，同時，單片機內的鎖相環電路可使能耗和性能適應具體操作的需要。車模主程序框架如圖4所示。

程序上電運行后，便進行單片機的初始化，包括單片機需要用到的資源進行初始化和應用程序初始化。

將車體角度和角速度乘以各自相對應的系數得出直立控制的輸出量。程序算法框圖如圖5所示。

直立控制算法部分代碼如下：

5 結束語

整車在方案設計、硬件搭建、機械結構調整、軟件編程調試、整體開發流程中，每一步都會遇到各種各樣的問題，硬件分模塊屏蔽調試，直到穩定，機械結構理論分析，不同方案試用對比，軟件優化各個控制參數，通過進一步對控制算法的改進提高車模的運行速度，實際測試效果良好。

參考文獻

[1]馮智勇，曾瀚，張力，趙亦欣，黃偉.基于陀螺儀及加速度計信號融合的姿態角度測量[J].西南師范大學學報，2011，36（4）：137-141.

[2]陳靜.兩輪自平衡機器人模型及控制方法研究[D].北京工業大學碩士學位論文，2008.

[3]Rich Chi Ooi.Balancing a Two-Wheeled Autonomous Robot[D].The University of Western Australia Final Year Thesis，2003.

[4]Gene F.Franklin，J.David Powell，Michael L.Workman.Digital Control of Dynamic Systems[M].北京：清華大學出社，2011.

作者簡介：嚴起邦（1990-），男，學生，黑龍江八一農墾大學，現主要從事兩輪平衡車方面研究學習。

通訊作者：譚峰，男，教授，哈爾濱工業大學畢業，現主要從事智能化監控技術的研究工作。endprint

摘 要：文章旨在研制一種自平衡同軸雙輪循跡小車。系統以陀螺儀和加速度計來檢測車身所處的狀態和變化率，通過處理器（16位飛思卡爾單片機MC9S12XS128）計算出適當數據和指令，通過PWM驅動兩個電機產生前進或后退的加速度使車達到保持平衡效果，以線性CCD光電傳感器來識別黑線檢測路徑，闡述了自平衡的原理同時對系統用到的PID控制技術做了相應介紹，從理論上分析了變積分的PID控制技術的優勢，并在系統的實際測試中獲得了良好的效果。

關鍵詞：光電平衡；xs128；智能車

1 引言

隨著智能化的發展，汽車的智能化、自動化是社會發展的必然趨勢。通過項目的研究使兩輪自平衡小車能夠智能的識別道路、加速、轉彎、避障等復雜路況，實現智能駕駛。同時兩輪自平衡小車使得車體更加靈活、減少交通擁堵、停車困難等實際生活問題，對于提高人們的生活水平有實際意義，最終設計小車在規定路徑上實現自動尋跡、智能壁障等功能。

2 平衡車原理

通過對單擺進行受力分析可知，單擺能夠穩定在垂直位置的條件有兩個：受到與位移（角度）相反的恢復力；受到與運動速度相反的阻尼力。控制倒立擺底部車輪，使得它作加速運動。這樣站在小車上看倒立擺，它在受到與車輪加速度大小成正比方向相反的慣性力的影響。 普通的單擺受力分析如圖1所示。

當物體離開垂直的平衡位置之后，便會受到重力與懸線的作用合力，驅動重物回復平衡位置。這個力稱之為回復力，其大小為F=-mgsin？茲≈-mg？茲，在此回復力F作用下，單擺便進行周期運動。在空氣中運動的單擺，由于受到空氣的阻尼力，單擺最終會停止在垂直平衡位置。空氣的阻尼力與單擺運行速度成正比，方向相反。阻尼力越大，單擺越會盡快在垂直位置穩定下來。

這樣倒立擺所受到的回復力為：

式中，假設偏角θ與控制車輪加速度成正比，比例為k1。如果k1>g那回復力與位移的方向相反。另外，增加阻尼力能讓倒立擺盡快回到原位置，阻尼力與偏角的速度成正比，方向相反。因此式（1）可變為：

將倒立擺模型轉換成單擺模型，使擺能夠穩定在豎直位置。從而得到控制平衡車車輪加速度的控制算法

3 系統硬件電路設計

3.1 系統整體設計

硬件整體框圖如圖2所示。智能車由電源模塊、傳感器模塊、電機驅動模塊、單片機最小系統等組成。智能車的工作過程：由線性CCD探測路徑信息，歐姆龍檢測當前車速，將各個傳感器采集來的信息交給處理器處理，通過控制算法得出PWM，來控制電機驅動模塊輸出相應的控制電壓，達到控制平衡、轉向、循跡的功能。

電機驅動電路如圖3所示，采用2片BTN7970組成一個完整的H橋驅動電路驅動l路有刷直流電機，P0、P2端分別接電機的兩端，BTN 1腳端接下拉電阻，PWM1與PWM5分別輸出非零占空比和零占空比的PWM，讓半橋各有一個導通，組成一個回路，電機驅動模塊由橋構成，H橋具有工作電壓范圍大，導通電阻小，導通電流大的優點。

3.2 PID控制原理

連續控制系統中PID控制規律如下：

其中 是偏差信號為零時的控制作用，是控制量的基準；利用外接矩形進行數值微分，當選定采樣周期為T時，式（4）可離散為下面的差分方程

增量式PID算式，

于是：

式（7）的計算結果，得出第k與第k-1次的輸出之間的增量，所以稱為增量算式。利用增量算式來控制執行程序，執行程序每次只增加一個增量，所以執行對象只是起到一個累加的作用。

4 系統軟件設計

MC9S12DG128 微控制單元作為MC9S12系列的16位單片機，由標準片上外圍設備組成，同時，單片機內的鎖相環電路可使能耗和性能適應具體操作的需要。車模主程序框架如圖4所示。

程序上電運行后，便進行單片機的初始化，包括單片機需要用到的資源進行初始化和應用程序初始化。

將車體角度和角速度乘以各自相對應的系數得出直立控制的輸出量。程序算法框圖如圖5所示。

直立控制算法部分代碼如下：

5 結束語

整車在方案設計、硬件搭建、機械結構調整、軟件編程調試、整體開發流程中，每一步都會遇到各種各樣的問題，硬件分模塊屏蔽調試，直到穩定，機械結構理論分析，不同方案試用對比，軟件優化各個控制參數，通過進一步對控制算法的改進提高車模的運行速度，實際測試效果良好。

參考文獻

[1]馮智勇，曾瀚，張力，趙亦欣，黃偉.基于陀螺儀及加速度計信號融合的姿態角度測量[J].西南師范大學學報，2011，36（4）：137-141.

[2]陳靜.兩輪自平衡機器人模型及控制方法研究[D].北京工業大學碩士學位論文，2008.

[3]Rich Chi Ooi.Balancing a Two-Wheeled Autonomous Robot[D].The University of Western Australia Final Year Thesis，2003.

[4]Gene F.Franklin，J.David Powell，Michael L.Workman.Digital Control of Dynamic Systems[M].北京：清華大學出社，2011.

作者簡介：嚴起邦（1990-），男，學生，黑龍江八一農墾大學，現主要從事兩輪平衡車方面研究學習。

通訊作者：譚峰，男，教授，哈爾濱工業大學畢業，現主要從事智能化監控技術的研究工作。endprint