一種基于arm9兩輪微電腦鼠快速對角線沖刺系統(tǒng)的制作方法
【專利摘要】本實(shí)用新型公開了一種基于ARM9兩輪微電腦鼠快速對角線沖刺系統(tǒng)，包括：電池裝置、按鍵裝置、傳感器裝置、單核全數(shù)字最小硬件伺服單元、左、右電機(jī)驅(qū)動單元、陀螺儀、左、右電機(jī)；所述單核全數(shù)字最小硬件伺服單元中通過運(yùn)動控制器ARM9實(shí)現(xiàn)參數(shù)轉(zhuǎn)化、多軸PWM波生成，然后與快速驅(qū)動控制器L298N和位于左右電機(jī)上的光電編碼器和電流傳感器之間電性連接。通過上述方式，本實(shí)用新型能夠提供一種用于兩輪微電腦鼠的全數(shù)字化快速對角線沖刺系統(tǒng)，通過前方導(dǎo)航傳感器和對角線傳感器相互配合實(shí)現(xiàn)微電腦鼠在復(fù)雜迷宮中的對角線快速沖刺，減少微電腦鼠沖刺時間。
【專利說明】—種基于ARM9兩輪微電腦鼠快速對角線沖刺系統(tǒng)
【技術(shù)領(lǐng)域】
[0001]本實(shí)用新型涉及一中微電腦鼠沖刺控制系統(tǒng)，特別是涉及一種基于ARM9兩輪微電腦鼠快速對角線沖刺系統(tǒng)。
【背景技術(shù)】
[0002]微電腦鼠是使用嵌入式微控制器、傳感器和機(jī)電運(yùn)動部件構(gòu)成的一種智能行走機(jī)器人，微電腦鼠可以在不同“迷宮”中自動記憶和選擇路徑，采用相應(yīng)的算法，快速地到達(dá)所設(shè)定的目的地。微電腦鼠比賽在國外已經(jīng)有30幾年的歷史，現(xiàn)在每年國際上都要舉行上百場類似的微電腦鼠大賽。
[0003]微電腦鼠競賽采用運(yùn)行時間、迷宮時間和碰觸這三個參數(shù)，從速度、求解迷宮的效率和電腦鼠的可靠性三個方面來進(jìn)行評分，不同的國家采用不同的評分標(biāo)準(zhǔn)，最有代表的四個國家標(biāo)準(zhǔn)為:
[0004]美國:IEEE APEC國際微電腦鼠機(jī)器人競賽，探索時間、沖刺時間和固定的接觸扣分，都記入總成績，得分=探索時間/30 +沖刺時間+固定接觸扣分；
[0005]日本:全日本國際微電腦鼠機(jī)器人大會(專家級)，總成績僅計算沖刺時間，得分=最佳沖刺時間；
[0006]英國:微電腦鼠機(jī)器人挑戰(zhàn)賽，探索時間、沖刺時間和可變的接觸扣分都記入總成績，得分=探索時間/30 +沖刺時間+變動接觸扣分；
[0007]新加坡:機(jī)器人大賽，探索時間、沖刺時間記入總成績；每次接觸機(jī)器人將減少一次嘗試機(jī)會，得分=探索時間/30 +沖刺時間。
[0008]從上面的國際標(biāo)準(zhǔn)來看，沖刺時間決定整個微電腦鼠的成敗，由于國內(nèi)研發(fā)此機(jī)器人的單位較少，相對研發(fā)水平比較落后，研發(fā)的微電腦鼠結(jié)構(gòu)如圖1，長時間運(yùn)行發(fā)現(xiàn)存在著很多安全問題，即:
[0009](I)作為微電腦鼠的眼睛采用的是超聲波或者是一般的紅外傳感器，而且傳感器的設(shè)置有誤，使得微電腦鼠在快速沖刺時對周圍迷宮的判斷存在一定的誤判，使得微電腦在快速沖刺的時候容易撞上前方的擋墻。
[0010](2)作為微電腦鼠的執(zhí)行機(jī)構(gòu)采用的是步進(jìn)電機(jī)，經(jīng)常會遇到丟失脈沖的問題出現(xiàn)，導(dǎo)致對沖刺位置的記憶出現(xiàn)錯誤，有的時候找不到?jīng)_刺的終點(diǎn)。
[0011](3)由于采用步進(jìn)電機(jī)，使得機(jī)體發(fā)熱比較嚴(yán)重，不利于在大型復(fù)雜迷宮中快速沖刺。
[0012](4)由于采用比較低級的算法，使得最佳迷宮的計算和沖刺路徑的計算都有一定的問題，研發(fā)的微電腦鼠基本上不會多次自動加速沖刺，在一般迷宮當(dāng)中的沖刺一般都要花費(fèi)15?30秒的時間，這使得在真正的國際復(fù)雜迷宮大賽中無法取勝。
[0013](5)由于微電腦鼠在快速沖刺過程中需要頻繁的剎車和啟動，加重了單片機(jī)的工作量，單片信號處理器無法滿足微電腦鼠快速沖刺的要求。
[0014](6)相對采用的都是一些體積比較大的插件元器件使得微電腦鼠的體積和重量比較龐大，而且重心較高，無法滿足快速沖刺的要求。
[0015](7)由于受周圍環(huán)境不穩(wěn)定因素干擾，特別是周圍一些光線的干擾，單片機(jī)控制器經(jīng)常會出現(xiàn)異常，引起微電腦鼠失控，抗干擾能力較差。
[0016](8)對于差速控制的微電腦鼠來說，一般要求其兩個電機(jī)的控制信號要同步，但是對于單一單片機(jī)來說很難辦到，使得微電腦鼠在高速沖刺時會在迷宮當(dāng)中搖擺幅度較大，經(jīng)常出現(xiàn)撞墻的現(xiàn)象發(fā)生，導(dǎo)致沖刺失敗。
[0017](9)由于受單片機(jī)容量和算法影響，微電腦鼠對迷宮的信息沒有存儲，當(dāng)遇到掉電情況時候所有的信息將消失，這使得整個沖刺過程無法完成。
[0018](10)由于沒有角速度傳感器的輔助進(jìn)行轉(zhuǎn)彎，經(jīng)常出現(xiàn)轉(zhuǎn)彎角度過小或者過大的現(xiàn)象發(fā)生，然后依靠導(dǎo)航的傳感器進(jìn)行補(bǔ)償，導(dǎo)致在連續(xù)多次轉(zhuǎn)彎的迷宮中出現(xiàn)撞墻的現(xiàn)象發(fā)生,致使沖刺失敗。
[0019](11)采用單個傳感器探知前方迷宮的擋墻，極易收到外界干擾，致使前方傳感器錯誤引導(dǎo)快速沖刺的微電腦鼠，導(dǎo)致微電腦鼠在迷宮中沖刺不到位或者撞墻，致使沖刺失敗。
[0020]因此，需要對現(xiàn)有的基于單片機(jī)控制的微電腦鼠控制器進(jìn)行重新設(shè)計。
實(shí)用新型內(nèi)容
[0021]本實(shí)用新型主要解決的技術(shù)問題是提供一種基于ARM9兩輪微電腦鼠快速對角線沖刺系統(tǒng)，能夠減少沖刺時間，對于樓梯型沖刺迷宮采用45度對角線轉(zhuǎn)法和U型沖刺迷宮采用U轉(zhuǎn)法，比連續(xù)轉(zhuǎn)法更加節(jié)省時間；并且在沖刺階段一直有前方的傳感器SI和S6對信息進(jìn)行采集并時刻進(jìn)行補(bǔ)償，保證了沖刺的準(zhǔn)確性和穩(wěn)定性。
[0022]為解決上述技術(shù)問題，本實(shí)用新型采用的一個技術(shù)方案是:提供一種基于ARM9兩輪微電腦鼠快速對角線沖刺系統(tǒng)，包括:電池裝置、按鍵裝置、傳感器、單核全數(shù)字最小硬件伺服單元、左、右電機(jī)驅(qū)動單元、陀螺儀、左、右電機(jī)；所述電池裝置、按鍵裝置、傳感器裝置、單核全數(shù)字最小硬件伺服單元與左、右電機(jī)驅(qū)動單和左、右電機(jī)之間電性連接；所述陀螺儀與所述單核全數(shù)字最小硬件伺服單元之間電性連接；所述單核全數(shù)字最小硬件伺服單元中進(jìn)一步設(shè)置有運(yùn)動控制器ARM9、PWM控制器、快速驅(qū)動控制器L298N和位于左右電機(jī)上的光電編碼器和電流傳感器，所述運(yùn)動控制器ARM9實(shí)現(xiàn)參數(shù)轉(zhuǎn)化模塊、多軸PWM波生成，并與快速驅(qū)動控制器L298N、光電編碼器、電流傳感器之間電性連接，從而所PWM信號由運(yùn)動控制器ARM9結(jié)合各種反饋生成后流向驅(qū)動控制器L298N。
[0023]在本實(shí)用新型一個較佳實(shí)施例中，所述單核全數(shù)字最小硬件伺服單元中進(jìn)一步包含有多個沖刺選擇模塊，所述沖刺選擇模塊與所述按鍵裝置連接；所述沖刺選擇模塊中進(jìn)一步包含有自動沖刺模塊、快速沖刺模塊和設(shè)定速度沖刺模塊，根據(jù)按鍵裝置實(shí)現(xiàn)自動沖刺模塊、快速沖刺模塊和設(shè)定速度沖刺模塊的選取。
[0024]在本實(shí)用新型一個較佳實(shí)施例中，所述單核全數(shù)字最小硬件伺服單元中還進(jìn)一步包含有沖刺運(yùn)動模塊，所述沖刺運(yùn)動模塊中進(jìn)一步包含有準(zhǔn)備沖刺單元、啟動沖刺單元和沖刺單元，所述準(zhǔn)備沖刺單元、啟動沖刺單元和沖刺單元之間按順序依次連接。
[0025]所述啟動沖刺單元中進(jìn)一步包含有中斷請求模塊和正常沖刺模塊，所述中斷請求模塊和正常沖刺模塊與啟動沖刺單元相互連接，從而所述信號分別流向斷請求模塊或正常沖刺模塊。
[0026]在本實(shí)用新型一個較佳實(shí)施例中，所述沖刺單元進(jìn)一步包含有直線沖刺單元、轉(zhuǎn)向沖刺單元、對角線沖刺單元和U型沖刺單元，所述直線沖刺單元、轉(zhuǎn)向沖刺單元、對角線沖刺單元和U型沖刺單元與所述伺服控制系統(tǒng)中的運(yùn)動控制器ARM9相連接。
[0027]在本實(shí)用新型一個較佳實(shí)施例中，所述直線沖刺單元、轉(zhuǎn)向沖刺單元、對角線沖刺單元和U型沖刺單元中包含有坐標(biāo)存儲模塊、子程序控制模塊。
[0028]在本實(shí)用新型一個較佳實(shí)施例中，所述轉(zhuǎn)向沖刺單元、對角線沖刺單元和U型沖刺單元中進(jìn)一步包含有曲線運(yùn)動軌跡模塊、誤差補(bǔ)償模塊、目標(biāo)模塊、速度調(diào)整模塊，所述曲線運(yùn)動軌跡模塊與坐標(biāo)存儲模塊連接，從而所述信號由子程序控制模塊流向坐標(biāo)存儲模塊和曲線運(yùn)動軌跡模塊；所述誤差補(bǔ)償模塊、速度調(diào)整模塊、陀螺儀分別與目標(biāo)模塊相連接，從而所述信號由目標(biāo)模塊流向誤差補(bǔ)償模塊、速度調(diào)整模塊或陀螺儀。
[0029]在本實(shí)用新型一個較佳實(shí)施例中，所述對角線沖刺單元還進(jìn)一步包含有對角線運(yùn)動模塊和距離模塊，所述對角線運(yùn)動模塊與坐標(biāo)存儲模塊由運(yùn)動控制器ARM9控制完成。
[0030]本實(shí)用新型的有益效果是:本實(shí)用新型在微電腦鼠的伺服控制系統(tǒng)中添加了控制微電腦鼠運(yùn)動的運(yùn)動控制器ARM9、通過參數(shù)轉(zhuǎn)化后由軟件生成多軸PWM波，所述PWM波經(jīng)快速驅(qū)動控制器L298N后輸送至左、右電機(jī)，通過上述方式能夠?qū)崿F(xiàn)微電腦鼠快速的對角線沖刺。
【專利附圖】

【附圖說明】
[0031]為了更清楚地說明本實(shí)用新型實(shí)施例中的技術(shù)方案，下面將對實(shí)施例描述中所需要使用的附圖作簡單地介紹，顯而易見地，下面描述中的附圖僅僅是本實(shí)用新型的一些實(shí)施例，對于本領(lǐng)域普通技術(shù)人員來講，在不付出創(chuàng)造性勞動的前提下，還可以根據(jù)這些附圖獲得其它的附圖，其中:
[0032]圖1是本實(shí)用新型一種基于ARM9兩輪微電腦鼠快速對角線沖刺系統(tǒng)一較佳實(shí)施例的結(jié)構(gòu)不意圖；
[0033]圖2為本實(shí)用新型一種基于ARM9兩輪微電腦鼠快速對角線沖刺系統(tǒng)的單核全數(shù)字最小硬件伺服單元框圖；
[0034]圖3為本實(shí)用新型一種基于ARM9兩輪微電腦鼠快速對角線沖刺系統(tǒng)一較佳實(shí)施例的單核全數(shù)字最小硬件伺服單元沖刺模塊框圖；
[0035]圖4是本實(shí)用新型一種基于ARM9兩輪微電腦鼠快速對角線沖刺系統(tǒng)一較佳實(shí)施例的微電腦鼠迷宮示意圖；
[0036]圖5是本實(shí)用新型一種基于ARM9兩輪微電腦鼠快速對角線沖刺系統(tǒng)一較佳實(shí)施例的微電腦鼠二維示意圖；
[0037]圖6是本實(shí)用新型一種基于ARM9兩輪微電腦鼠快速對角線沖刺系統(tǒng)一較佳實(shí)施例的為微電腦鼠速度曲線圖；
[0038]圖7是本實(shí)用新型一種基于ARM9兩輪微電腦鼠快速對角線沖刺系統(tǒng)一較佳實(shí)施例的微電腦鼠自動沖刺程序示意圖；
[0039]圖8是本實(shí)用新型一種基于ARM9兩輪微電腦鼠快速對角線沖刺系統(tǒng)一較佳實(shí)施例的為微電腦鼠右轉(zhuǎn)沖刺示意圖；[0040]圖9是本實(shí)用新型一種基于ARM9兩輪微電腦鼠快速對角線沖刺系統(tǒng)一較佳實(shí)施例的微電腦鼠左轉(zhuǎn)沖刺不意圖；
[0041]圖10是本實(shí)用新型一種基于ARM9兩輪微電腦鼠快速對角線沖刺系統(tǒng)一較佳實(shí)施例的樓梯迷宮圖；
[0042]圖11是本實(shí)用新型一種基于ARM9兩輪微電腦鼠快速對角線沖刺系統(tǒng)一較佳實(shí)施例的45度沖刺樓梯示意圖；
[0043]圖12是本實(shí)用新型一種基于ARM9兩輪微電腦鼠快速對角線沖刺系統(tǒng)一較佳實(shí)施例的連轉(zhuǎn)U型迷宮圖；
[0044]圖13是本實(shí)用新型一種基于ARM9兩輪微電腦鼠快速對角線沖刺系統(tǒng)一較佳實(shí)施例的連轉(zhuǎn)U型示意圖；
[0045]圖14是本實(shí)用新型一種基于ARM9兩輪微電腦鼠快速對角線沖刺系統(tǒng)一較佳實(shí)施例的連轉(zhuǎn)U型迷宮參數(shù)示意圖。。
[0046]附圖中各部件的標(biāo)記如下:1、左電機(jī)；2、右電機(jī)；3、傳感器。
【具體實(shí)施方式】
[0047]下面將對本實(shí)用新型實(shí)施例中的技術(shù)方案進(jìn)行清楚、完整地描述，顯然，所描述的實(shí)施例僅是本實(shí)用新型的一部分實(shí)施例，而不是全部的實(shí)施例?；诒緦?shí)用新型中的實(shí)施例，本領(lǐng)域普通技術(shù)人員在沒有做出創(chuàng)造性勞動前提下所獲得的所有其它實(shí)施例，都屬于本實(shí)用新型保護(hù)的范圍。
[0048]請參閱圖1、圖2和圖3，本實(shí)用新型實(shí)施例提供如下技術(shù)方案。
[0049]在一個實(shí)施例中，一種基于ARM9兩輪微電腦鼠快速對角線沖刺系統(tǒng),包括:電池裝置、按鍵裝置、傳感器、單核全數(shù)字最小硬件伺服單元、左、右電機(jī)驅(qū)動單元、陀螺儀、左、右電機(jī)；所述電池裝置、按鍵裝置、傳感器裝置、單核全數(shù)字最小硬件伺服單元與左、右電機(jī)驅(qū)動單和左、右電機(jī)之間電性連接；所述陀螺儀與所述單核全數(shù)字最小硬件伺服單元之間電性連接；所述單核全數(shù)字最小硬件伺服單元中進(jìn)一步設(shè)置有運(yùn)動控制器ARM9、PWM控制器、快速驅(qū)動控制器L298N和位于左右電機(jī)上的光電編碼器和電流傳感器，所述運(yùn)動控制器ARM9實(shí)現(xiàn)參數(shù)轉(zhuǎn)化模塊、多軸PWM波生成，并與快速驅(qū)動控制器L298N、光電編碼器、電流傳感器之間電性連接，從而所PWM信號由運(yùn)動控制器ARM9結(jié)合各種反饋生成后流向驅(qū)動控制器L298N。
[0050]區(qū)別于現(xiàn)有技術(shù)，在一個實(shí)施例中，所述單核全數(shù)字最小硬件伺服單元中進(jìn)一步包含有多個沖刺選擇模塊，所述沖刺選擇模塊與所述按鍵裝置連接；所述沖刺選擇模塊中進(jìn)一步包含有自動沖刺模塊、快速沖刺模塊和設(shè)定速度沖刺模塊，根據(jù)按鍵裝置實(shí)現(xiàn)自動沖刺模塊、快速沖刺模塊和設(shè)定速度沖刺模塊的選取。
[0051]所述單核全數(shù)字最小硬件伺服單元中還進(jìn)一步包含有沖刺運(yùn)動模塊，所述沖刺運(yùn)動模塊中進(jìn)一步包含有準(zhǔn)備沖刺單元、啟動沖刺單元和沖刺單元，所述準(zhǔn)備沖刺單元、啟動沖刺單元和沖刺單元之間按順序依次連接。
[0052]所述啟動沖刺單元中進(jìn)一步包含有中斷請求模塊和正常沖刺模塊，所述中斷請求模塊和正常沖刺模塊與啟動沖刺單元相互連接，從而所述信號分別流向斷請求模塊或正常沖刺模塊。[0053]所述沖刺單元進(jìn)一步包含有直線沖刺單元、轉(zhuǎn)向沖刺單元、對角線沖刺單元和U型沖刺單元，所述直線沖刺單元、轉(zhuǎn)向沖刺單元、對角線沖刺單元和U型沖刺單元與所述伺服控制系統(tǒng)中的運(yùn)動控制器ARM9相連接。
[0054]所述直線沖刺單元、轉(zhuǎn)向沖刺單元、對角線沖刺單元和U型沖刺單元中包含有坐標(biāo)存儲模塊、子程序控制模塊。
[0055]所述轉(zhuǎn)向沖刺單元、對角線沖刺單元和U型沖刺單元中進(jìn)一步包含有曲線運(yùn)動軌跡模塊、誤差補(bǔ)償模塊、目標(biāo)模塊、速度調(diào)整模塊，所述曲線運(yùn)動軌跡模塊與坐標(biāo)存儲模塊連接，從而所述信號由子程序控制模塊流向坐標(biāo)存儲模塊和曲線運(yùn)動軌跡模塊；所述誤差補(bǔ)償模塊、速度調(diào)整模塊、陀螺儀分別與目標(biāo)模塊相連接，從而所述信號由目標(biāo)模塊流向誤差補(bǔ)償模塊、速度調(diào)整模塊或陀螺儀。
[0056]所述對角線沖刺單元還進(jìn)一步包含有對角線運(yùn)動模塊和距離模塊，所述對角線運(yùn)動模塊與坐標(biāo)存儲模塊由運(yùn)動控制器ARM9控制完成。
[0057]為了進(jìn)一步描述微電腦鼠的運(yùn)動，請參照圖4、圖5、圖6、圖7、圖8、圖9、圖10、圖
11、圖12、圖13、圖14，其具體功能實(shí)現(xiàn)如下:
[0058]在微電腦鼠打開電源瞬間，系統(tǒng)按照圖7的方式完成沖刺。首先系統(tǒng)要完成初始化，然后等待按鍵信息，未接到按鍵信息命令之前，微電腦鼠在起點(diǎn)坐標(biāo)(0，O)等待控制器發(fā)出的沖刺命令。根據(jù)按鍵信息，本實(shí)用新型有多種沖刺方法:如果按下的是STARTO^a)鍵，說明系統(tǒng)要放棄以前的迷宮信息先進(jìn)行搜索，然后搜索完成后生成優(yōu)化的沖刺迷宮信息，微電腦鼠進(jìn)入自動多次沖刺階段；如果按下的是RESET (復(fù)位)+STRAT (啟動)鍵，說明系統(tǒng)要調(diào)出已經(jīng)探索后的最優(yōu)迷宮，然后沿著起點(diǎn)開始快速向終點(diǎn)(7，7)、( 7，8)、(8，7)、(8，8)沖刺；如果按下的是RESET (復(fù)位)+STRAT (啟動)+SPEED (速度)鍵，說明系統(tǒng)要調(diào)出已經(jīng)探索后的最優(yōu)迷宮，然后沿著起點(diǎn)以設(shè)定的沖刺速度開始快速向終點(diǎn)(7，7)、(7，8)、(8，
`7)、(8，8)沖刺。
[0059]微電腦鼠放在起點(diǎn)坐標(biāo)(0，0)，接到任務(wù)后為了防止放錯沖刺方向，其前方的傳感器S1、S6和會對前方的環(huán)境進(jìn)行判斷，確定有沒有擋墻進(jìn)入運(yùn)動范圍。如存在擋墻將向ARM9 (S3C2440A)發(fā)出中斷請求，ARM9 (S3C2440A)會對中斷做第一時間響應(yīng)，然后禁止L298N的使能端ENA和ENB工作，封鎖微電腦鼠的左電機(jī)I和右電機(jī)2的PWM驅(qū)動信號，使其靜止在原地，然后二次判斷迷宮確定前方信息，防止信息誤判；如果沒有擋墻進(jìn)入前方的運(yùn)動范圍，微電腦鼠將進(jìn)行正常的沖刺。
[0060]在微電腦啟動沖刺瞬間，傳感器S1、S2、S3、S4、S5、S6 (六個獨(dú)立的紅外發(fā)射管0PE5594A發(fā)出的紅外光經(jīng)接收器TSL262接受后轉(zhuǎn)化為周圍迷宮的信息)判斷周圍的環(huán)境并送給ARM9 (S3C2440A)，然后由ARM9 (S3C2440A)根據(jù)沖刺迷宮信息生成圖6所示的梯形圖指令給定值，這個圖形包含的面積就是微電腦鼠兩個左電機(jī)1、右電機(jī)2要運(yùn)行的距離
S。然后結(jié)合光電編碼盤和電流傳感器的反饋生成驅(qū)動兩軸直流電機(jī)的PWM波。PWM波經(jīng)L298N后驅(qū)動兩個獨(dú)立電機(jī)，完成整個加速過程直到達(dá)到?jīng)_刺設(shè)定速度，并把處理數(shù)據(jù)通訊給ARM9 (S3C2440A)，由ARM9 (S3C2440A)繼續(xù)處理后續(xù)的運(yùn)行狀態(tài)。
[0061]本實(shí)用新型舍棄了傳統(tǒng)單一速度沖刺模式，按照圖6的速度和時間曲線控制微電腦鼠的加速和減速。梯形圖包含的面積為微電腦鼠運(yùn)動Z格的距離。在微電腦鼠沿著Y軸向前快速沖刺過程中如果迷宮信息中顯示前方有Z格直線坐標(biāo)下沒有擋墻進(jìn)入前方的運(yùn)動范圍，微電腦鼠將存儲其現(xiàn)在的坐標(biāo)(X，Y)，系統(tǒng)進(jìn)入沖刺子程序1，ARM9 (S3C2440A)把向前運(yùn)動Z格的位置參數(shù)根據(jù)沖刺條件的不同計算出速度參數(shù)以及加速度參數(shù)指令值，然后結(jié)合光電編碼器和電流傳感器的反饋根據(jù)內(nèi)部位置、速度、加速度程序生成形成當(dāng)前條件下的PWM波，然后ARM9 (S3C2440A)通過調(diào)整L298N管腳0UT1、0UT3、0UT2、0UT4為電平，控制左右輪的左電機(jī)I和右電機(jī)2向前運(yùn)動。當(dāng)?shù)竭_(dá)設(shè)定目標(biāo)時，將更新其坐標(biāo)為(X，Y+Z),為了快速沖刺需要，在其向前運(yùn)動過程到達(dá)既定目標(biāo)時，在Y+Z〈 15的前提下，判斷其坐標(biāo)是不是(7，7)、(7，8)、(8，7)、(8，8)其中的一個，如果不是將繼續(xù)更新其坐標(biāo)，如果是的話通知控制器已經(jīng)沖刺到目標(biāo)，然后置返航探索標(biāo)志為1，沖刺標(biāo)志為O,微電腦鼠準(zhǔn)備沖刺后的二次返程探索，去搜尋更優(yōu)的迷宮路徑；
[0062]在微電腦鼠沿著Y軸反向向前快速沖刺過程中如果迷宮信息中顯示前方有Z格直線坐標(biāo)下沒有擋墻進(jìn)入前方的運(yùn)動范圍，微電腦鼠將存儲其現(xiàn)在的坐標(biāo)(X，Y)，系統(tǒng)進(jìn)入沖刺子程序1，ARM9 (S3C2440A)把向前運(yùn)動Z格的位置參數(shù)根據(jù)沖刺條件的不同計算出速度參數(shù)以及加速度參數(shù)指令值，然后結(jié)合光電編碼器和電流傳感器的反饋根據(jù)內(nèi)部位置、速度、加速度程序生成形成當(dāng)前條件下的PWM波，然后ARM9(S3C2440A)通過調(diào)整L298N管腳0UT1、0UT3、0UT2、0UT4為電平，控制左右輪的左電機(jī)I和右電機(jī)2向前運(yùn)動，當(dāng)?shù)竭_(dá)設(shè)定目標(biāo)時，將更新其坐標(biāo)為(X，Y-Z),在其向前運(yùn)動過程到達(dá)既定目標(biāo)時，在確定Υ-Ζ>0的前提下，判斷其坐標(biāo)是不是(7，7)、(7，8)、(8，7)、(8，8)其中的一個，如果不是將繼續(xù)更新其坐標(biāo)，如果是的話通知控制器已經(jīng)沖刺到目標(biāo)，然后置返航探索標(biāo)志為1，沖刺標(biāo)志為0，微電腦鼠準(zhǔn)備沖刺后的二次返程探索，去搜尋更優(yōu)的迷宮路徑；
[0063]在微電腦鼠沿著Y軸向前運(yùn)動過程中如果有擋墻進(jìn)入前方的運(yùn)動范圍，并且此時迷宮信息中左方有擋墻時，系統(tǒng)進(jìn)入沖刺子程序2，微電腦鼠將存儲此時坐標(biāo)(X，Y)，然后進(jìn)入圖8所示的曲線運(yùn)動軌跡，在右沖刺轉(zhuǎn)彎時，ARM9 (S3C2440A)首先把行走直線很短的距離DashTurn_R90_Leading按照不同的沖刺條件時間要求轉(zhuǎn)化為速度參數(shù)以及加速度參數(shù)指令值，然后結(jié)合左電機(jī)I和右電機(jī)2上的光電編碼器和電流傳感器的反饋經(jīng)內(nèi)部位置、速度和加速度控制程序，生成控制左右輪的PWM波給L298N，然后控制左右輪以相同的加速度和速度直線前進(jìn)；當(dāng)?shù)竭_(dá)既定目標(biāo)時，傳感器參考值R90_FrontWallRef開始工作，防止外界干擾開始做誤差補(bǔ)償。誤差補(bǔ)償結(jié)束后開始調(diào)整直流左電機(jī)I和直流右電機(jī)2速度為DashTurn_R90_VelXl和DashTurn_R90_VdYl，此時控制器會把曲線運(yùn)動軌跡DashTurn_R90_Arcl按照不同的沖刺條件時間要求轉(zhuǎn)化為速度參數(shù)以及加速度參數(shù)指令值，然后結(jié)合左電機(jī)I和右電機(jī)2上的光電編碼器和電流傳感器的反饋經(jīng)內(nèi)部位置、速度和加速度控制程序，生成控制左右輪的PWM波給L298N，然后控制左右輪以恒定的比值轉(zhuǎn)彎；當(dāng)?shù)竭_(dá)既定目標(biāo)后，立即調(diào)整微電腦鼠速度為DashTurn_R90_VelX2和DashTurn_R90_VelY2,此時控制器會把曲線運(yùn)動軌跡DashTurn_R90_Arc2按照不同的沖刺條件時間要求轉(zhuǎn)化為速度參數(shù)以及加速度參數(shù)指令值，然后結(jié)合左電機(jī)I和右電機(jī)2上的光電編碼器和電流傳感器的反饋經(jīng)內(nèi)部位置、速度和加速度控制程序，生成控制左右輪的PWM波給L298N，然后控制左右輪以恒定的比值轉(zhuǎn)彎；當(dāng)?shù)竭_(dá)既定目標(biāo)后，微電腦鼠在陀螺儀控制下已經(jīng)右轉(zhuǎn)90度,控制器把直線行走很短的距離DashTurn_R90_Passing按照不同的沖刺條件時間要求轉(zhuǎn)化為速度參數(shù)以及加速度參數(shù)指令值，然后結(jié)合左電機(jī)I和右電機(jī)2上的光電編碼器和電流傳感器的反饋經(jīng)內(nèi)部位置、速度和加速度控制程序，生成控制左右輪的PWM波給L298N，然后控制左右輪以相同的加速度和速度前進(jìn)，當(dāng)?shù)竭_(dá)既定目標(biāo)后通過四段不同的軌跡完成整個右轉(zhuǎn)彎的軌跡曲線運(yùn)動。此時將更新其坐標(biāo)為(X+1，Y)，在X+l〈15的前提下，判斷其坐標(biāo)是不是(7，7)、(7，8)、(8，7)、(8，8)其中的一個，如果不是將繼續(xù)更新其坐標(biāo)，如果是的話通知控制器已經(jīng)沖刺到目標(biāo)，然后置返航探索標(biāo)志為1，沖刺標(biāo)志為O，微電腦鼠準(zhǔn)備沖刺后的二次返程探索，去搜尋更優(yōu)的迷宮路徑。
[0064]在微電腦鼠沿著Y軸向前運(yùn)動過程中如果有擋墻進(jìn)入前方的運(yùn)動范圍，并且此時迷宮信息中右方有擋墻時，系統(tǒng)進(jìn)入沖刺子程序3，微電腦鼠將存儲此時坐標(biāo)(X，Y)，然后進(jìn)入圖8所示的曲線運(yùn)動軌跡，在左沖刺轉(zhuǎn)彎時，ARM9 (S3C2440A)首先把行走直線很短的距離DashTurn_L90_Leading按照不同的沖刺條件時間要求轉(zhuǎn)化為速度參數(shù)以及加速度參數(shù)指令值，然后結(jié)合左電機(jī)I和右電機(jī)2上的光電編碼器和電流傳感器的反饋經(jīng)內(nèi)部位置、速度和加速度控制程序，生成控制左右輪的PWM波給L298N，然后控制左右輪以相同的加速度和速度直線前進(jìn)；當(dāng)?shù)竭_(dá)既定目標(biāo)時，傳感器參考值L90_FrontWallRef開始工作，防止外界干擾開始做誤差補(bǔ)償。誤差補(bǔ)償結(jié)束后開始調(diào)整直流左電機(jī)I和直流右電機(jī)2速度為DashTurn_L90_VelXl和DashTurn_L90_VelYl，此時控制器會把曲線運(yùn)動軌跡DashTurn_L90_Arcl按照不同的沖刺條件時間要求轉(zhuǎn)化為速度參數(shù)以及加速度參數(shù)指令值，然后結(jié)合左電機(jī)I和右電機(jī)2上的光電編碼器和電流傳感器的反饋經(jīng)內(nèi)部位置、速度和加速度控制程序，生成控制左右輪的PWM波給L298N，然后控制左右輪以恒定的比值前進(jìn)；當(dāng)?shù)竭_(dá)既定目標(biāo)后，立即調(diào)整微電腦鼠速度為DashTurn_L90_VelX2和DashTurn_L90_VeIY2，此時控制器會把曲線運(yùn)動軌跡DashTurn_L90_Arc2按照不同的沖刺條件時間要求轉(zhuǎn)化為速度參數(shù)以及加速度參數(shù)指令值，然后結(jié)合左電機(jī)I和右電機(jī)2上的光電編碼器和電流傳感器的反饋經(jīng)內(nèi)部位置、速度和加速度控制程序，生成控制左右輪的PWM波給L298N，然后控制左右輪以恒定的比值前進(jìn)；當(dāng)?shù)竭_(dá)既定目標(biāo)后，微電腦鼠在陀螺儀控制下已經(jīng)左轉(zhuǎn)90度,控制器把直線行走很短的距離DashTurn_L90_Passing按照不同的沖刺條件時間要求轉(zhuǎn)化為速度參數(shù)以及加速度參數(shù)指令值，然后結(jié)合左電機(jī)I和右電機(jī)2上的光電編碼器和電流傳感器的反饋經(jīng)內(nèi)部位置、速度和加速度控制程序，生成控制左右輪的PWM波給L298N，然后控制左右輪以相同的加速度和速度前進(jìn)，當(dāng)?shù)竭_(dá)既定目標(biāo)后通過四段不同的軌跡完成整個左轉(zhuǎn)彎的軌跡曲線運(yùn)動。此時將更新其坐標(biāo)為(X-1，Y)，在X-l〈15的前提下，判斷其坐標(biāo)是不是(7，7)、(7，8)、(8，7)、(8，8)其中的一個，如果不是將繼續(xù)更新其坐標(biāo)，如果是的話通知控制器已經(jīng)沖刺到目標(biāo)，然后置返航探索標(biāo)志為1，沖刺標(biāo)志為0，微電腦鼠準(zhǔn)備沖刺后的二次返程探索，去搜尋更優(yōu)的迷宮路徑。
[0065]在微電腦鼠沿著X軸、Y軸向前運(yùn)動過程中如果有類似圖10的樓梯型迷宮擋墻進(jìn)入前方的運(yùn)動范圍，系統(tǒng)進(jìn)入沖刺子程序4，微電腦鼠將存儲此時坐標(biāo)(X，Y)，然后進(jìn)入圖11所示的對角線運(yùn)動軌跡，在坐標(biāo)為(X，Y)時，ARM9 (S3C2440A)控制直流左電機(jī)I和直流右電機(jī)2以相同的速度勻速前進(jìn)，在前進(jìn)過程中傳感器S2、S3和S4、S5共同作用，保證微電腦鼠沖刺的時候一定沿著迷宮中線行駛，即將沖出坐標(biāo)為(X，Y)迷宮方格時，微電腦鼠前方傳感器SI和S6將工作，當(dāng)讀到預(yù)設(shè)值時，說明微電腦鼠的前部已經(jīng)進(jìn)入坐標(biāo)(X+1，Y)，然后把微電腦鼠傳感器SI位置到電機(jī)中心的距離SX傳輸給ARM9 (S3C2440A)，ARM9 (S3C2440A)首先把行走直線很短的距離SX按照不同的沖刺條件時間要求轉(zhuǎn)化為速度參數(shù)以及加速度參數(shù)指令值，然后結(jié)合左電機(jī)I和右電機(jī)2上的光電編碼器和電流傳感器的反饋經(jīng)內(nèi)部位置、速度和加速度控制程序，生成控制左右輪的PWM波給L298N，然后控制左右輪以相同的加速度和速度直線前進(jìn)；當(dāng)?shù)竭_(dá)既定目標(biāo)時，把此時的迷宮坐標(biāo)更新為(X+1，Y)；
[0066] 微電腦鼠開始為45度對角線沖刺做姿態(tài)調(diào)整，此時控制器會把曲線運(yùn)動軌跡L_Arcl_45按照不同的沖刺條件時間要求轉(zhuǎn)化為速度參數(shù)以及加速度參數(shù)指令值，然后結(jié)合左電機(jī)I和右電機(jī)2上的光電編碼器和電流傳感器的反饋經(jīng)內(nèi)部位置、速度和加速度控制程序，生成控制左右輪的PWM波給L298N，然后控制左右輪以恒定的比值前進(jìn)；當(dāng)?shù)竭_(dá)既定目標(biāo)后，立即調(diào)整微電腦鼠左右輪的速度，控制器把曲線運(yùn)動軌跡L_Arc2_45按照不同的沖刺條件時間要求轉(zhuǎn)化為速度參數(shù)以及加速度參數(shù)指令值，然后結(jié)合左電機(jī)I和右電機(jī)2上的光電編碼器和電流傳感器的反饋經(jīng)內(nèi)部位置、速度和加速度控制程序，生成控制左右輪的PWM波給L298N，然后控制左右輪以恒定的比值前進(jìn)；在陀螺儀的控制下，保證到達(dá)當(dāng)?shù)竭_(dá)既定目標(biāo)A點(diǎn)時曲線L_Arc2_45的斜率為45度，然后控制器把直線行走很短的距離Passingl按照不同的沖刺條件時間要求轉(zhuǎn)化為速度參數(shù)以及加速度參數(shù)指令值，然后結(jié)合左電機(jī)I和右電機(jī)2上的光電編碼器和電流傳感器的反饋經(jīng)內(nèi)部位置、速度和加速度控制程序，生成控制左右輪的PWM波給L298N，然后控制左右輪以相同的加速度和速度前進(jìn)。當(dāng)?shù)竭_(dá)既定目標(biāo)后，通過三段不同的軌跡完成整個左轉(zhuǎn)彎45度方向改變的軌跡曲線運(yùn)動。微電腦鼠進(jìn)入對角線沖刺階段，此時前方傳感器SI和S6開始工作；ARM9 (S3C2440A)首先把
行走直線距離按照不同的沖刺條件時間要求轉(zhuǎn)化為速度參數(shù)以及加速度參數(shù)指令值，然后結(jié)合左電機(jī)I和右電機(jī)2上的光電編碼器反饋、電流傳感器的反饋和傳感器SI和S6對前方柱子的探測，經(jīng)內(nèi)部位置、速度和加速度控制程序，生成控制左右輪的PWM波給L298N,然后控制左右輪以相同的加速度和速度直線前進(jìn)；當(dāng)?shù)竭_(dá)既定目標(biāo)時，微電腦鼠完成在坐標(biāo)(X+l，Y+1)到坐標(biāo)(X+2，Y+1)下的對角線沖刺，微電腦鼠完成一格樓梯迷宮的沖刺，把此時的迷宮坐標(biāo)更新為(X+2，Y+2)。依次類推，微電腦鼠完成Z格樓梯迷宮的沖刺，更新迷宮為(X+Z+l，Y+Z+1 )，微電腦鼠開始做轉(zhuǎn)出動作，此時控制器會把曲線運(yùn)動軌跡R_Arc3_45按照不同的沖刺條件時間要求轉(zhuǎn)化為速度參數(shù)以及加速度參數(shù)指令值，然后結(jié)合左電機(jī)I和右電機(jī)2上的光電編碼器和電流傳感器的反饋經(jīng)內(nèi)部位置、速度和加速度控制程序，生成控制左右輪的PWM波給L298N，然后控制左右輪以恒定的比值前進(jìn)；當(dāng)?shù)竭_(dá)既定目標(biāo)后，立即調(diào)整微電腦鼠左右輪的速度，控制器把曲線運(yùn)動軌跡R_Arc4_45按照不同的沖刺條件時間要求轉(zhuǎn)化為速度參數(shù)以及加速度參數(shù)指令值，然后結(jié)合左電機(jī)I和右電機(jī)2上的光電編碼器和電流傳感器的反饋經(jīng)內(nèi)部位置、速度和加速度控制程序，生成控制左右輪的PWM波給L298N，然后控制左右輪以恒定的比值前進(jìn)；在陀螺儀的控制下，保證到達(dá)當(dāng)?shù)竭_(dá)既定目標(biāo)B點(diǎn)時曲線R_Arc4_45的斜率為O度，然后控制器把直線行走很短的距離Passing2按照不同的沖刺條件時間要求轉(zhuǎn)化為速度參數(shù)以及加速度參數(shù)指令值，然后結(jié)合左電機(jī)I和右電機(jī)2上的光電編碼器和電流傳感器的反饋經(jīng)內(nèi)部位置、速度和加速度控制程序，生成控制左右輪的PWM波給L298N，然后控制左右輪以相同的加速度和速度前進(jìn)，當(dāng)?shù)竭_(dá)既定目標(biāo)后通過三段不同的軌跡完成在坐標(biāo)(X+Z+l，Y+Z+1)下整個右轉(zhuǎn)彎45度曲線軌跡的運(yùn)動，微電腦鼠完成對角線沖刺后變?yōu)橹甭返能壽E改變，微電腦鼠進(jìn)入直線沖刺階段，此時前方傳感器S2、S3、S4和S5開始工作，進(jìn)入直線導(dǎo)航；并更新當(dāng)前坐標(biāo)為(X+Z+2，Y+Z+1)在 X+Z+2〈15 和 Y+Z+K15 的前提下，判斷其坐標(biāo)是不是(7，7)、(7，8)、(8，7)、(8，8)其中的一個，如果不是將繼續(xù)更新其坐標(biāo)，如果是的話通知控制器已經(jīng)沖刺到目標(biāo)，然后置返航探索標(biāo)志為1，沖刺標(biāo)志為O，微電腦鼠準(zhǔn)備沖刺后的二次返程探索，去搜尋更優(yōu)的迷
宮路徑。
[0067]在微電腦鼠沿著X軸、Y軸向前運(yùn)動過程中如果有類似圖12的U型迷宮擋墻進(jìn)入前方的運(yùn)動范圍，微電腦鼠將存儲此時坐標(biāo)(X，Y)，系統(tǒng)進(jìn)入沖刺子程序5，然后進(jìn)入圖13、圖14所示的曲線運(yùn)動軌跡，在一次左沖刺轉(zhuǎn)彎時，ARM9 (S3C2440A)首先把行走直線很短的距離Leadingl按照不同的沖刺條件時間要求轉(zhuǎn)化為速度參數(shù)以及加速度參數(shù)指令值，然后結(jié)合左電機(jī)I和右電機(jī)2上的光電編碼器和電流傳感器的反饋經(jīng)內(nèi)部位置、速度和加速度控制程序，生成控制左右輪的PWM波給L298N，然后控制左右輪以相同的加速度和速度直線前進(jìn)；當(dāng)?shù)竭_(dá)既定目標(biāo)時，把此時的迷宮坐標(biāo)更新為(X+1，Y)，傳感器參考值L90_FrontffallRef開始工作，防止外界干擾開始做誤差補(bǔ)償。誤差補(bǔ)償結(jié)束后，控制器會把曲線運(yùn)動軌跡L_Arcl按照不同的沖刺條件時間要求轉(zhuǎn)化為速度參數(shù)以及加速度參數(shù)指令值，然后結(jié)合左電機(jī)I和右電機(jī)2上的光電編碼器和電流傳感器的反饋經(jīng)內(nèi)部位置、速度和加速度控制程序，生成控制左右輪的PWM波給L298N，然后控制左右輪的速度以恒定的比值轉(zhuǎn)彎；當(dāng)?shù)竭_(dá)既定目標(biāo)后，立即調(diào)整微電腦鼠的速度，控制器會把曲線運(yùn)動軌跡L_Arc2按照不同的沖刺條件時間要求轉(zhuǎn)化為速度參數(shù)以及加速度參數(shù)指令值，然后結(jié)合左電機(jī)I和右電機(jī)2上的光電編碼器和電流傳感器的反饋經(jīng)內(nèi)部位置、速度和加速度控制程序，生成控制左右輪的PWM波給L298N，然后控制左右輪的速度以恒定的比值轉(zhuǎn)彎；當(dāng)?shù)竭_(dá)既定目標(biāo)后，微電腦鼠在陀螺儀控制下已經(jīng)左轉(zhuǎn)90度，控制器把直線行走很短的距離Passingl+Leading2,按照不同的沖刺條件時間要求轉(zhuǎn)化為速度參數(shù)以及加速度參數(shù)指令值，然后結(jié)合左電機(jī)I和右電機(jī)2上的光電編碼器和電流傳感器的反饋經(jīng)內(nèi)部位置、速度和加速度控制程序，生成控制左右輪的PWM波給L298N，然后控制左右輪以相同的加速度和速度前進(jìn)，當(dāng)傳感器S2的值產(chǎn)生有高電平到低電平的躍變時，更新微電腦鼠坐標(biāo)為(X+1，Y+1)，微電腦鼠繼續(xù)以當(dāng)前的速度和加速前進(jìn)，當(dāng)?shù)竭_(dá)既定目標(biāo)時，傳感器參考值L90_FrOntWallRef開始工作，防止外界干擾開始做誤差補(bǔ)償。誤差補(bǔ)償結(jié)束后，微電腦鼠繼續(xù)左轉(zhuǎn)，控制器會把曲線運(yùn)動軌跡L_Arcl按照不同的沖刺條件時間要求轉(zhuǎn)化為速度參數(shù)以及加速度參數(shù)指令值，然后結(jié)合左電機(jī)I和右電機(jī)2上的光電編碼器和電流傳感器的反饋經(jīng)內(nèi)部位置、速度和加速度控制程序，生成控制左右輪的PWM波給L298N，然后控制左右輪的速度以恒定的比值轉(zhuǎn)彎；當(dāng)?shù)竭_(dá)既定目標(biāo)后，立即調(diào)整微電腦鼠的速度，控制器會把曲線運(yùn)動軌跡L_Arc2按照不同的沖刺條件時間要求轉(zhuǎn)化為速度參數(shù)以及加速度參數(shù)指令值，然后結(jié)合左電機(jī)I和右電機(jī)2上的光電編碼器和電流傳感器的反饋經(jīng)內(nèi)部位置、速度和加速度控制程序，生成控制左右輪的PWM波給L298N，然后控制左右輪的速度以恒定的比值轉(zhuǎn)彎；當(dāng)?shù)竭_(dá)既定目標(biāo)后，微電腦鼠在陀螺儀控制下已經(jīng)左轉(zhuǎn)90度，控制器把直線行走很短的距離Passing2按照不同的沖刺條件時間要求轉(zhuǎn)化為速度參數(shù)以及加速度參數(shù)指令值，然后結(jié)合左電機(jī)I和右電機(jī)2上的光電編碼器和電流傳感器的反饋經(jīng)內(nèi)部位置、速度和加速度控制程序，生成控制左右輪的PWM波給L298N，然后控制左右輪以相同的加速度和速度前進(jìn)，到達(dá)既定目標(biāo)后，微電腦鼠完成一個U型迷宮的沖刺，更新微電腦鼠坐標(biāo)為(X，Y+1),并判斷其坐標(biāo)是不是(7，7)、(7,8), (8,7), (8,8)其中的一個，如果不是將繼續(xù)更新其坐標(biāo)，如果是的話通知控制器已經(jīng)沖刺到目標(biāo)，然后置返航探索標(biāo)志為1，沖刺標(biāo)志為0，微電腦鼠準(zhǔn)備沖刺后的二次返程探索，去搜尋更優(yōu)的迷宮路徑。[0068]當(dāng)微電腦鼠沖刺到達(dá)(7，7)、(7，8)、(8，7)、(8，8)后會準(zhǔn)備沖刺后的返程探索以便搜尋更優(yōu)的路徑，控制器會調(diào)出其已經(jīng)存儲的迷宮信息，然后計算出可能存在的其它最佳路徑，然后返程開始進(jìn)入其中認(rèn)為最優(yōu)的一條。
[0069]為了能夠?qū)崿F(xiàn)微電腦鼠快速沖刺準(zhǔn)確的坐標(biāo)計算功能，微電腦鼠左右的傳感器S2、S3和S4、S5會時刻對周圍的迷宮擋墻和柱子進(jìn)行探測，如果S2、S3或者S4、S5發(fā)現(xiàn)傳感器信號發(fā)生了躍變，則說明微電腦鼠進(jìn)入了迷宮擋墻和柱子的交接點(diǎn)，此時側(cè)面?zhèn)鞲衅鱏2或者是S5會精確探測這一時刻，當(dāng)再次出現(xiàn)躍變時，說明老鼠已經(jīng)開始離開當(dāng)前的迷宮格子，ARM9(S3C2440A)會根據(jù)微電腦鼠當(dāng)前運(yùn)行的距離進(jìn)行計算并根據(jù)對傳感器反饋信息進(jìn)行補(bǔ)償，本實(shí)用新型在高速直流左電機(jī)I軸和Y軸上加入了 512線的光碼盤，由于精度較高，使得微電腦鼠的坐標(biāo)計算不會出現(xiàn)錯誤，保證了微電腦鼠快速沖刺迷宮信息的準(zhǔn)請性。
[0070]在微電腦鼠進(jìn)入迷宮返程探索時，其導(dǎo)航的傳感器S1、S2、S3、S4、S5、S6將工作，并把反射回來的光電信號送給ARM9(S3C2440A)，經(jīng)ARM9(S3C2440A)運(yùn)算后確定現(xiàn)在迷宮所處位置，然后由ARM9(S3C2440A)根據(jù)當(dāng)前迷宮生成PWM波和送控制信號給L298N:如果進(jìn)入已經(jīng)搜索的區(qū)域?qū)⒓哟驪WM波的占空比，使微電腦鼠進(jìn)行快速前進(jìn)，減少迷宮搜索的時間；如果是未知返回區(qū)域則采用正常速度搜索，并時刻更新其坐標(biāo)(X，Y)，并判斷其坐標(biāo)是不是(0，0)，如果是的話置返航探索標(biāo)志為0，微電腦鼠進(jìn)入沖刺階段，并置沖刺標(biāo)志為
1
[0071]在微電腦鼠運(yùn)動過程中，如果系統(tǒng)出現(xiàn)了干擾，ARM9(S3C2440A)會根據(jù)當(dāng)前狀態(tài)對電流加以補(bǔ)償，快速調(diào)整電流環(huán)的PID參數(shù)，使得系統(tǒng)快速穩(wěn)定下來，防止高速沖刺時干擾對系統(tǒng)的影響。
[0072]在微電腦鼠快速沖刺過程中，電池提供的瞬時功率是一定的，在沖刺速度一定的條件下，加速度越大時，需要的力矩就越大，此時需要電池提供的電流就越大，為了保護(hù)電池，本實(shí)用新型加入了電流傳感器，杜絕了加速時對電池的傷害。
[0073]當(dāng)微電腦完成整個沖刺過程到達(dá)(7，7)、(7，8)、(8，7)、(8，8)，微電腦鼠會置探索標(biāo)志為1，微電腦鼠返程探索回到起始點(diǎn)(0，0)，ARM9 (S3C2440A)將控制L298N使得微電腦起始點(diǎn)中心點(diǎn)停車，然后重新調(diào)整L298N的0UT1、0UT2、0UT3和0UT4的電平，使得左電機(jī)I和右電機(jī)2以相反的方向運(yùn)動，并在陀螺儀的控制下，原地旋轉(zhuǎn)180度，然后停車I秒，二次調(diào)取迷宮信息，然后根據(jù)算法算出優(yōu)化迷宮信息后的最優(yōu)沖刺路徑，然后置沖刺標(biāo)志為1，系統(tǒng)進(jìn)入二次快速沖刺階段。然后按照沖刺一一探索一沖刺，完成多次的沖刺，以達(dá)到快速沖刺的目的。
[0074]以上所述僅為本實(shí)用新型的實(shí)施例，并非因此限制本實(shí)用新型的專利范圍，凡是利用本實(shí)用新型說明書及附圖內(nèi)容所作的等效結(jié)構(gòu)或等效流程變換，或直接或間接運(yùn)用在其它相關(guān)的【技術(shù)領(lǐng)域】，均同理包括在本實(shí)用新型的專利保護(hù)范圍內(nèi)。
【權(quán)利要求】
1.一種基于ARM9兩輪微電腦鼠快速對角線沖刺系統(tǒng)，其特征在于:包括:電池裝置、按鍵裝置、傳感器、單核全數(shù)字最小硬件伺服單元、左、右電機(jī)驅(qū)動單元、陀螺儀、左、右電機(jī)；所述電池裝置、按鍵裝置、傳感器裝置、單核全數(shù)字最小硬件伺服單元與左、右電機(jī)驅(qū)動單和左、右電機(jī)之間電性連接；所述陀螺儀與所述單核全數(shù)字最小硬件伺服單元之間電性連接；所述單核全數(shù)字最小硬件伺服單元中進(jìn)一步設(shè)置有運(yùn)動控制器ARM9、PWM控制器、快速驅(qū)動控制器L298N和位于左右電機(jī)上的光電編碼器和電流傳感器，所述運(yùn)動控制器ARM9實(shí)現(xiàn)參數(shù)轉(zhuǎn)化模塊、多軸PWM波生成，并與快速驅(qū)動控制器L298N、光電編碼器、電流傳感器之間電性連接，從而所PWM信號由運(yùn)動控制器ARM9結(jié)合各種反饋生成后流向驅(qū)動控制器L298N。
2.根據(jù)權(quán)利要求1所述的一種基于ARM9兩輪微電腦鼠快速對角線沖刺系統(tǒng)，其特征在于:所述單核全數(shù)字最小硬件伺服單元中進(jìn)一步包含有多個沖刺選擇模塊，所述沖刺選擇模塊與所述按鍵裝置連接；所述沖刺選擇模塊中進(jìn)一步包含有自動沖刺模塊、快速沖刺模塊和設(shè)定速度沖刺模塊，根據(jù)按鍵裝置實(shí)現(xiàn)自動沖刺模塊、快速沖刺模塊和設(shè)定速度沖刺模塊的選取。
3.根據(jù)權(quán)利要求2所述的一種基于ARM9兩輪微電腦鼠快速對角線沖刺系統(tǒng)，其特征在于:所述單核全數(shù)字最小硬件伺服單元中還進(jìn)一步包含有沖刺運(yùn)動模塊，所述沖刺運(yùn)動模塊中進(jìn)一步包含有準(zhǔn)備沖刺單元、啟動沖刺單元和沖刺單元，所述準(zhǔn)備沖刺單元、啟動沖刺單元和沖刺單元之間按順序依次連接。
4.根據(jù)權(quán)利要求3所述的一種基于ARM9兩輪微電腦鼠快速對角線沖刺系統(tǒng)，其特征在于:所述啟動沖刺單元中進(jìn)一步包含有中斷請求模塊和正常沖刺模塊，所述中斷請求模塊和正常沖刺模塊與啟動沖刺單元相互連接，從而所述信號分別流向斷請求模塊或正常沖刺模塊。
5.根據(jù)權(quán)利要求4所述的一種基于ARM9兩輪微電腦鼠快速對角線沖刺系統(tǒng)，其特征在于:所述沖刺單元進(jìn)一步包含有直線沖刺單元、轉(zhuǎn)向沖刺單元、對角線沖刺單元和U型沖刺單元，所述直線沖刺單元、轉(zhuǎn)向沖刺單元、對角線沖刺單元和U型沖刺單元與所述伺服控制系統(tǒng)中的運(yùn)動控制器ARM9相連接。
6.根據(jù)權(quán)利要求5所述的一種基于ARM9兩輪微電腦鼠快速對角線沖刺系統(tǒng)，其特征在于:所述直線沖刺單元、轉(zhuǎn)向沖刺單元、對角線沖刺單元和U型沖刺單元中包含有坐標(biāo)存儲模塊、子程序控制模塊。
7.根據(jù)權(quán)利要求6所述的一種基于ARM9兩輪微電腦鼠快速對角線沖刺系統(tǒng)，其特征在于:所述轉(zhuǎn)向沖刺單元、對角線沖刺單元和U型沖刺單元中進(jìn)一步包含有曲線運(yùn)動軌跡模塊、誤差補(bǔ)償模塊、目標(biāo)模塊、速度調(diào)整模塊，所述曲線運(yùn)動軌跡模塊與坐標(biāo)存儲模塊連接，從而所述信號由子程序控制模塊流向坐標(biāo)存儲模塊和曲線運(yùn)動軌跡模塊；所述誤差補(bǔ)償模塊、速度調(diào)整模塊、陀螺儀分別與目標(biāo)模塊相連接，從而所述信號由目標(biāo)模塊流向誤差補(bǔ)償模塊、速度調(diào)整模塊或陀螺儀。
8.根據(jù)權(quán)利要求7所述的一種基于ARM9兩輪微電腦鼠快速對角線沖刺系統(tǒng)，其特征在于:所述對角線沖刺單元還進(jìn)一步包含有對角線運(yùn)動模塊和距離模塊，所述對角線運(yùn)動模塊與坐標(biāo)存儲模塊由運(yùn)動控制器ARM9控制完成。
【文檔編號】G05D1/02GK203643841SQ201320622667
【公開日】2014年6月11日 申請日期:2013年10月10日 優(yōu)先權(quán)日:2013年10月10日
【發(fā)明者】王應(yīng)海, 張好明 申請人:蘇州工業(yè)園區(qū)職業(yè)技術(shù)學(xué)院