飛思卡爾電磁智能車技術(shù)報(bào)告(原理與算法調(diào)試說明)很詳細(xì)的資料下載

ID:430533 · 發(fā)表于 2018-12-2 16:19

這是相關(guān)電磁組資料
僅供參考

本文主要?jiǎng)?chuàng)新點(diǎn)如下：
1．提出了基于三次多項(xiàng)式曲線擬合的位置解算算法。該算法采用三次多項(xiàng)式來擬合通電導(dǎo)線周圍磁場(chǎng)強(qiáng)度變化曲線，從而解算出小車相對(duì)賽道的偏移距離。該算法在滿足實(shí)時(shí)性與檢測(cè)精度的前提下，對(duì)復(fù)雜賽道具有很強(qiáng)的適應(yīng)性。
2．給出了基于賽道曲率的“阿克曼轉(zhuǎn)向”控制算法。該算法通過位置偏差計(jì)算出賽道曲率，然后應(yīng)用“阿克曼轉(zhuǎn)向模型”計(jì)算出轉(zhuǎn)角控制量。該轉(zhuǎn)向控制算法能適應(yīng)各種曲率的賽道，克服了已有方法在大半徑賽道中的抖動(dòng)現(xiàn)象。

（2）電機(jī)驅(qū)動(dòng)系統(tǒng)
可逆 PWM 變換電路有多種形式，最常用的是橋式（亦稱 H 型）變換器。它是由四個(gè)功率開關(guān)器件和四個(gè)續(xù)流二極管組成的電路，其特點(diǎn)是可以改變電機(jī)電樞上的電源電壓的正負(fù)極，使得直流電機(jī)可以在四象限中運(yùn)行。

主控器系統(tǒng)包括單片機(jī)及其外部電路、人機(jī)接口模塊。競(jìng)賽所使用的單片機(jī)為競(jìng)賽組委會(huì)指定的飛思卡爾公司的 9S12XS128。它是以運(yùn)算速度很快的 CPU12 內(nèi)核為核心的單片機(jī)，經(jīng)過鎖相環(huán)后，時(shí)鐘頻率可達(dá)到88MHz，內(nèi)部 Flash 高至 128KB，擁有 2 組各 8 路 10 位 A/D、16 路 I/O 口，有功能強(qiáng)大的 8 路 8 位 PWM 輸出，以及 8 路 16 位增強(qiáng)型定時(shí)器（ECT）。該單片機(jī)功能強(qiáng)大，完全能夠勝任小車的檢測(cè)和控制功能。[3]

人機(jī)接口模塊是為了方便單片機(jī)與調(diào)試者之間的交互而設(shè)計(jì)的，一般包括 LED 指示燈、撥碼開關(guān)、鍵盤、液晶顯示屏、蜂鳴器、無線串口模塊和 SD 卡等。LED 可以顯示簡(jiǎn)單的工作狀態(tài)，蜂鳴器可以用于告警和指示，撥碼開關(guān)可以用于簡(jiǎn)單的模式設(shè)置，液晶顯示屏與鍵盤聯(lián)合使用可以進(jìn)行實(shí)時(shí)調(diào)試，無線模塊用于少量數(shù)據(jù) 的收發(fā)，SD 卡可用于大量運(yùn)行數(shù)據(jù)的存儲(chǔ)。

（4）傳感器系統(tǒng)
傳感器系統(tǒng)一般包括用于檢測(cè)交變磁場(chǎng)的電磁傳感器模塊、起始線檢測(cè)模塊、用于檢測(cè)小車速度的脈沖編碼器模塊、檢測(cè)小車加速度的加速度模塊和檢測(cè)小車傾斜角度的角度傳感器或陀螺儀。
(a) 電磁傳感器模塊
電磁組的傳感器用于磁定位，根據(jù)誘導(dǎo)信號(hào)的產(chǎn)生方式不同分為信號(hào)電纜、磁帶、道路磁釘及磁釘與磁帶混合定位等。這次比賽所用的就是通有 20kHz、100mA 交流電的導(dǎo)線。傳感器的種類有很多：磁通門傳感器、霍爾傳感器、磁阻傳感器等。

通過理論計(jì)算，100mA 交流電的導(dǎo)線有效距離內(nèi)的磁場(chǎng)強(qiáng)度為 10-4

-10-2
Gs，因此可供選擇的傳感器有電磁感應(yīng)線圈、霍爾效應(yīng)電磁傳感器等。傳感器電路中的放大電路通常有兩種方案，一種是三極管放大，一種是采用運(yùn)放放大。兩種方案各有優(yōu)缺點(diǎn)。
使用運(yùn)放的放大電路具有增益可調(diào)、放大線性度好、輸出紋波小等優(yōu)點(diǎn)。但是運(yùn)放一般都需要正負(fù)供電電源，而負(fù)電源較難設(shè)計(jì)；運(yùn)放的輸出電壓范圍要比輸入電壓低，從而限制了信號(hào)輸入范圍；且工作參數(shù)滿足我們需求的運(yùn)放價(jià)格都比較昂貴。
使用三極管放大電路具有電路簡(jiǎn)單、開關(guān)速度高、能很好的放大交流信號(hào)等優(yōu)點(diǎn)。但是三極管放大靜態(tài)工作點(diǎn)難調(diào)、放大倍數(shù)不高、容易出現(xiàn)各種失真等現(xiàn)象。
在上屆比賽中，各參賽隊(duì)基本都使用了以電磁線圈為測(cè)量元件、以三極管為放大元件和兩倍壓半波整流電路構(gòu)成傳感器電路。

(b)  起始線檢測(cè)模塊
起始線檢測(cè)傳感器用于檢測(cè)磁場(chǎng)強(qiáng)度為 3000Gs-5000Gs 的永久磁鐵，常用的傳感器為霍爾元件或磁敏開關(guān)器件（干簧管）。

脈沖編碼器又稱碼盤，是一種回轉(zhuǎn)式數(shù)字測(cè)量元件，通常裝在被檢測(cè)軸上，隨被測(cè)軸一起轉(zhuǎn)動(dòng)，可將被測(cè)軸的角位移轉(zhuǎn)換為增量脈沖形式或絕對(duì)式的代碼形式。根據(jù) 內(nèi)部結(jié)構(gòu)和檢測(cè)方式碼盤可分為接觸式、光電式和電磁式 3 種。其中，光電碼盤在數(shù)控機(jī)床上應(yīng)用較多，而由霍爾效應(yīng)構(gòu)成的電磁碼盤則可用作速度檢測(cè)元件。另外，它還可分為絕對(duì)式和增量式兩種。
目前被各參賽隊(duì)廣泛使用的脈沖編碼器為歐姆龍公司的光電編碼器或遠(yuǎn)征公司的光電編碼器。
(d)  加速度傳感器模塊及傾角傳感器模塊
為了獲取小車在運(yùn)動(dòng)中橫向、縱向加速度及車輛傾斜角，對(duì)小車的運(yùn)動(dòng)姿態(tài)進(jìn)行更加有效地控制，就必須要獲得小車在運(yùn)動(dòng)過程中的三個(gè)方向的加速度及傾斜角。
目前各參賽隊(duì)廣泛使用飛思卡爾公司的 MMA7260 模擬加速度傳感器或 MMA7450 數(shù)字加速度傳感器來測(cè)量加速度或傾角。有的隊(duì)還使用高性能的陀螺儀來測(cè)量小車經(jīng)過坡道時(shí)的傾角。

（5）車體系統(tǒng)
車體系統(tǒng)包括舵機(jī)安裝與轉(zhuǎn)向機(jī)構(gòu)設(shè)計(jì)，主銷后傾角、主銷內(nèi)傾角、前輪外傾角、前輪前束優(yōu)化調(diào)整，車體重心配置，差速器優(yōu)化等方面。主銷后傾角是指主銷的軸線相對(duì)于車輪的中心線向后傾斜的角度。前輪重心在主銷的軸線上由于主銷向后傾斜使前輪的重心不在車輪與地面的接觸點(diǎn)上，于是產(chǎn)生了離心力，主銷后傾形成的離心力，可以保證汽車直線行駛的穩(wěn)定性還可以幫助車輪自動(dòng)回正。主銷后傾角延長(zhǎng)線離地面實(shí)際接觸越遠(yuǎn)，車速越高，離心力就越大。在中高速行駛中保持汽車直線行駛的穩(wěn)定性，適當(dāng)?shù)募哟笾麂N后傾角可以幫助轉(zhuǎn)向輪自動(dòng)回正，可有效扼制轉(zhuǎn)向器的擺振，可使轉(zhuǎn)向便輕，單獨(dú)適量調(diào)一側(cè)主銷后傾角可修理行駛跑偏。
主銷內(nèi)傾角是指主銷的軸線相對(duì)于車輪的中心線向內(nèi)傾斜的角度。由于主銷軸線向內(nèi)傾斜，所以使前軸荷更接近前輪中心線。主銷內(nèi)傾軸線延長(zhǎng)線在沒超過前輪中心線的前提下，離前輪中心線越近，轉(zhuǎn)向角越大，轉(zhuǎn)向輪抬起的越高，車輪的回正力矩就越大。
轉(zhuǎn)向輪上端略向外傾斜叫前輪外傾角。它的作用是增大車輪工作的安全性。汽車在空載時(shí)如車輪垂直于路面，承載后由于懸架的變形會(huì)出現(xiàn)車
輪內(nèi)傾，使前輪軸荷輪轂外端轉(zhuǎn)移，由于外端軸承明顯小于內(nèi)端軸承，于是就增大了車輪工作的不安全性。為了增大車輪工作的安全性，大部分后
輪驅(qū)動(dòng)汽車，前輪都留有一定的外傾角，承載后車輪正好垂直于路面。前輪前束為了抵消前輪外傾點(diǎn)來轉(zhuǎn)向輪向兩側(cè)滾開的趨勢(shì)，最大限度地減少車輪行駛中的橫向滑移率。它可以修正前輪外傾帶來的不良影響。
1.2.2  軟件系統(tǒng)
軟件系統(tǒng)主要包括橫向控制算法及縱向控制算法。橫向控制算法包括位置解算算法和舵機(jī)控制算法，縱向控制算法包括速度規(guī)劃算法和電機(jī)控制算法。

（1）位置解算算法
目前被各隊(duì)廣泛采用的位置解算算法主要有兩種，一是基于無限長(zhǎng)導(dǎo)線電磁感應(yīng)公式，解算出偏離賽道信息，簡(jiǎn)稱公式法；二是通過對(duì)稱傳感器的差值在一定范圍內(nèi)近似線性化來近似得出偏離賽道信息，簡(jiǎn)稱差值斜率法。
（2）速度規(guī)劃算法
速度規(guī)劃算法沒有固定的形式，有的小車根本沒有速度規(guī)劃，只是單純地建立了位置偏差與速度對(duì)應(yīng)關(guān)系，通過位置偏差得出期望運(yùn)行速度。從上年的情況來看，取得好成績(jī)的隊(duì)伍都是使用了比較有效的速度規(guī)劃算法。在通常情況下，速度規(guī)劃算法應(yīng)包括入彎減速算法、出彎加速算法、坡道低速算法等。
（3）控制算法
目前最常用的控制算法是 PID 控制算法。PID 控制是按偏差的比例、積分和微分進(jìn)行控制的一種控制規(guī)律。它具有原理簡(jiǎn)單，易于實(shí)現(xiàn),參數(shù)整定方便，結(jié)構(gòu)改變靈活，適用性強(qiáng)等優(yōu)點(diǎn)。由于賽道情況復(fù)雜，干擾較多，
突變較多，加入微分控制會(huì)對(duì)電機(jī)造成很大干擾，因此電機(jī)控制算法使用PI 控制算法；由于舵機(jī)是一個(gè)大延遲系統(tǒng)，加入積分控制會(huì)使系統(tǒng)不穩(wěn)定，而且小車運(yùn)動(dòng)過程中不需要考慮之前走過的路徑，因此舵機(jī)控制算法使用PD 控制算法。

4.1.1  調(diào)試軟件實(shí)時(shí)調(diào)試
在軟件上，可以使用 Codewarrior4.7 的仿真功能，通過 BDM 仿真器觀察程序中參數(shù)的變化。本調(diào)試方法可以用來測(cè)試小車算法，觀察小車錯(cuò)誤，實(shí)時(shí)性強(qiáng)，調(diào)試結(jié)果清晰，并且可以設(shè)置斷點(diǎn)，進(jìn)入程序內(nèi)部觀察程序走向。但該調(diào)試方式受單片機(jī)內(nèi)存的限制，不能存儲(chǔ)大量的數(shù)據(jù)，因此不能用作整車的數(shù)據(jù)分析。
4.1.2  雙機(jī)通信實(shí)時(shí)調(diào)試
為了方便的獲小車的各種信息，專門購買了用于航模的
APC200A-43 多通道微功率嵌入式無線數(shù)傳模塊作為無線傳輸工具。
APC200A-43 模塊是高度集成半雙工微功率無線數(shù)據(jù)傳輸模塊，其嵌入高速單片機(jī)和高性能射頻芯片。APC200A-43 模塊提供了多個(gè)頻道的選擇，能夠透明傳輸任何大小的數(shù)據(jù)，而用戶無須編寫復(fù)雜的設(shè)置與傳輸程序，并提供 UART/TTL，RS485 以及 RS232 三種接口。同時(shí)小體積，寬電壓運(yùn)行，較遠(yuǎn)傳輸距離，豐富便捷的軟件編程設(shè)置功能，使 APC200A-43 模塊能夠應(yīng)用與非常廣泛的領(lǐng)域。將一個(gè) APC200A-43 作為單片機(jī)終端，另一個(gè)經(jīng)過 USB 轉(zhuǎn)接口作為 PC 機(jī)終端。通過單片機(jī)的 SCI 模塊，向上位機(jī)發(fā)送數(shù)據(jù)。

4.1.3  MATLAB 或 EXCEL 數(shù)據(jù)分析
MATLAB 可以用來對(duì)算法進(jìn)行仿真，在前期用來驗(yàn)證算法的可行性。通過無線串口獲得小車的運(yùn)行狀況的數(shù)據(jù)后，可以通過 EXCEL 將數(shù)據(jù)處理，繪制數(shù)據(jù)圖形，給人以直觀的印象，便于分析算法的優(yōu)劣。其具體使用見 4.2 節(jié)。
4.2  調(diào)試流程及調(diào)試結(jié)果
4.2.1  位置解算算法仿真分析
使用 MATLAB 對(duì)公式 2-11 進(jìn)行仿真，并取在傳感器對(duì)應(yīng)位置的值來做位置解算算法的輸入，并通過 MATLAB 擬合分析，可以得到：該車的實(shí)際偏移位置為 0cm，算法計(jì)算的偏移位置為-0.1cm，誤差為0.1cm。
綜上所述，該算法的精度在 5mm 以上，并且偏移位置越小，誤差越小，滿足了小車的控制要求。
4.2.2  電機(jī) PI 參數(shù)測(cè)試
通過使用無線串口將單片機(jī)運(yùn)動(dòng)中的實(shí)時(shí)速度發(fā)送至計(jì)算機(jī)，然后通過 EXCEL 繪圖，便可得出在不同的控制參數(shù)下小車的速度趨勢(shì)曲線，便可從曲線中得出超調(diào)量、調(diào)節(jié)時(shí)間等動(dòng)態(tài)參數(shù)。以下為期望速度為 200 時(shí)不同 PI 參數(shù)時(shí)的速度曲線。

由上述分析可得，增大 KI，速度的調(diào)節(jié)時(shí)間減少，超調(diào)量增加。通過多次數(shù)據(jù)比對(duì)，我們最后取得的電機(jī) PI 參數(shù)為 KP=12,KI=0.7。
4.3  整車聯(lián)調(diào)測(cè)試及結(jié)果

測(cè)試賽道如圖 4-10 所示，該賽道具有元素多、難度大等特點(diǎn)。為了便于分析，將本賽道分解為幾個(gè)部分，分別是小 S 部分、大 S 部分、太極彎部分、直道入急彎部分、坡道部分、大回環(huán)部分。下面針對(duì)各部分進(jìn)行賽道分析及展示調(diào)試結(jié)果。為了便于描述，下文中使用了弱化轉(zhuǎn)向、中等轉(zhuǎn)向、強(qiáng)化轉(zhuǎn)向等術(shù)語，其含義是對(duì)算法得出的控制量乘以一定的系數(shù)。弱化轉(zhuǎn)向乘以小于 1 的系數(shù)，具體大小與控制量相關(guān)；中等轉(zhuǎn)向不改變控制輸出量；強(qiáng)化轉(zhuǎn)向乘以大于 1 的系數(shù)，具體大小與控制量相關(guān)。
1. 小 S 部分
小 S 道的偏移量相對(duì)較小，但是賽道曲率中心在不斷改變，需要頻繁換向，這對(duì)于前瞻不大、信息量不足的電磁小車來說，如果沒有一個(gè)很好的控制方案，小車在該賽道中就會(huì)劇烈抖動(dòng)，速度快的話就會(huì)跑出賽道。本文提出的基于賽道曲率的“阿克曼轉(zhuǎn)向”控制方案與原始的基于位置偏差的控制方案不同，它可以實(shí)時(shí)預(yù)測(cè)到賽道的曲率及曲率中心的變化。當(dāng)賽道的曲率較大且曲率中心頻繁變換時(shí)，我們便可以知道小車正處于小S 道。此時(shí)我們便使用轉(zhuǎn)向弱化、中速前進(jìn)的控制方案。小車在小 S 道的運(yùn)動(dòng)軌跡示意圖如圖 4-11 所示。

2.  大 S 部分
大 S 的偏移量相對(duì)較大，但是賽道的曲率中心不頻繁改變。在大 S 道中的轉(zhuǎn)向控制較為簡(jiǎn)單，但是速度控制是一個(gè)難點(diǎn)。如何在大 S 道中實(shí)現(xiàn)彎道切換時(shí)減速，在彎道中加速，是提高競(jìng)賽成績(jī)的一個(gè)關(guān)鍵點(diǎn)。本文提出的基于賽道曲率的控制方案可以很好得解決上述問題。當(dāng)賽道曲率不斷改變、曲率中心只出現(xiàn)一次改變時(shí)，我們就可以認(rèn)為是進(jìn)入了彎道切換狀態(tài)，此時(shí)便采用加強(qiáng)轉(zhuǎn)向、低速前進(jìn)的控制方案；當(dāng)賽道曲率較大，曲率中心不變時(shí)，我們就可以認(rèn)為是進(jìn)入彎道狀態(tài)，此時(shí)采用中等轉(zhuǎn)向、中高速前進(jìn)的控制方案。小車在大 S 道中的運(yùn)動(dòng)軌跡示意圖如圖 4-12所示。

3.  太極彎部分
太極彎部分的賽道間距較小，容易發(fā)生串?dāng)_現(xiàn)象；太極彎部分對(duì)小車的轉(zhuǎn)向性能要求很高，給予的調(diào)整空間較小。本文提出的基于三次多項(xiàng)式擬合的位置解算算法魯棒性很高，可以克服各種干擾的影響，顯然臨近導(dǎo)線段對(duì)傳感器的干擾也可以大致消除。事實(shí)上，我們可以把太極彎當(dāng)做一個(gè)對(duì)轉(zhuǎn)向性能要求更高的大 S 道。因此，我們采用了強(qiáng)化轉(zhuǎn)向，低速前進(jìn)的控制方案。小車在太極彎部分的運(yùn)動(dòng)軌跡示意圖如圖 4-13 所示。

4.  直道入急彎部分
在直道部分時(shí)，賽道曲率幾乎為 0。如果此時(shí)控制參數(shù)過大，容易產(chǎn)生頻繁抖動(dòng)情況。若在直道時(shí)給予很高速度，那么在直道入急彎時(shí)便會(huì)因?yàn)檗D(zhuǎn)向延遲而跑出賽道。
本文提出的基于賽道曲率的“阿克曼轉(zhuǎn)向”控制方案可以很好得解決這個(gè)問題。當(dāng)賽道曲率小于一定值的時(shí)候，我們便采取弱化轉(zhuǎn)向、高速前進(jìn)的控制方案。當(dāng)賽道曲率小于一定值持續(xù)了一定時(shí)間，我們便可以知道目前的賽道是直道，從而采取最高速前進(jìn)方案。當(dāng)檢測(cè)到賽道曲率有大變化時(shí)，我們便可知道前方有急彎，此時(shí)便采取強(qiáng)化轉(zhuǎn)向，緊急剎車的控制方案。小車在直道入急彎部分的運(yùn)行軌跡示意圖如圖 4-14 所示。

5.  坡道部分
比賽中所使用坡道為前后各 15° 的梯形坡，頂部為直道。爬坡時(shí)，傳感器的高度會(huì)不斷發(fā)生變化，從而導(dǎo)致傳感器的值也在不斷發(fā)生變化，這對(duì)基于公式的位置算法與對(duì)稱差值的位置算法帶來了很大的誤差。本文提出的基于三次多項(xiàng)式擬合的位置解算算法的輸出只由當(dāng)前的傳感器值決定，因此它可以很好得解決小車在坡道時(shí)的位置檢測(cè)問題。
由于小車在上下坡時(shí)的抖動(dòng)很大，考慮到小車運(yùn)動(dòng)的穩(wěn)定性，故小車在坡道上必須中低速前進(jìn)。
6.  大回環(huán)部分
大回環(huán)的曲率一般較小，且賽道較長(zhǎng)，如何在大回環(huán)提速，是提高小車速度的關(guān)鍵點(diǎn)之一。本文提出的基于賽道曲率的“阿克曼轉(zhuǎn)向”控制方案可以檢測(cè)出大回環(huán)的曲率，并由此曲率計(jì)算出阿克曼轉(zhuǎn)角，控制舵機(jī)轉(zhuǎn)向，實(shí)現(xiàn)在轉(zhuǎn)角基本不變時(shí)高速前進(jìn)。因此，在大回環(huán)賽道中，采取了中等轉(zhuǎn)向、高速前進(jìn)的控制方案。小車在大回環(huán)部分的運(yùn)動(dòng)軌跡示意圖如圖 4-15所示。

經(jīng)過優(yōu)化控制方案和改進(jìn)算法，目前小車在本測(cè)試賽道上已經(jīng)可以達(dá)到穩(wěn)定速度 2.6m/s，峰值速度 2.8m/s 的水平。

完整的pdf格式文檔51黑下載地址：

飛思卡爾技術(shù)報(bào)告.pdf (3.04 MB, 下載次數(shù): 542)

ID:1 · 發(fā)表于 2018-12-2 16:51

好資料，51黑有你更精彩!!!

ID:328014 · 發(fā)表于 2018-12-2 16:51

很詳細(xì)的解說，收藏

ID:282520 · 發(fā)表于 2018-12-3 15:57

好資料阿

ID:398600 · 發(fā)表于 2019-6-26 11:54

感謝樓主

ID:626350 · 發(fā)表于 2019-10-18 20:10

這是第幾屆的啊

ID:472106 · 發(fā)表于 2019-11-13 18:47

好資料

ID:548678 · 發(fā)表于 2019-11-27 11:28

好資料

ID:801809 · 發(fā)表于 2020-7-11 22:05

很詳細(xì)的解說，收藏

ID:812447 · 發(fā)表于 2020-8-8 16:02

很有幫助

ID:688873 · 發(fā)表于 2021-5-6 10:22

好資料，51黑有你更精彩!!!

ID:920352 · 發(fā)表于 2021-5-13 21:46

好資料，51黑有你更精彩!!!

ID:1003226 · 發(fā)表于 2022-2-23 15:25

好資料，51黑有你更精彩!!!

ID:1007037 · 發(fā)表于 2022-2-27 12:29

樓主太強(qiáng)了，小白膜拜

帳號(hào)		自動(dòng)登錄	找回密碼
密碼			立即注冊(cè)