基于arm9四輪快速微電腦鼠對角線沖刺系統(tǒng)的制作方法
【專利摘要】本發(fā)明公開了一種基于ARM9四輪快速微電腦鼠對角線沖刺系統(tǒng)，包括處理器單元、電機(jī)X、電機(jī)Y、電機(jī)Z、電機(jī)R以及微電腦鼠機(jī)械裝置，所述的處理器單元分別與電機(jī)X、電機(jī)Y、電機(jī)Z以及電機(jī)R進(jìn)行電性連接，所述的電機(jī)X、電機(jī)Y、電機(jī)Z以及電機(jī)R與微電腦鼠機(jī)械裝置進(jìn)行連接，其中，所述的處理器單元包括ARM9處理器和L298N芯片，所述的ARM9處理器和L298N芯片進(jìn)行電性連接。本發(fā)明提供的基于ARM9四輪快速微電腦鼠對角線沖刺系統(tǒng)，抗干擾能力大大增強(qiáng)，同時(shí)提高了運(yùn)算速度，保證基于ARM9四輪快速微電腦鼠對角線沖刺系統(tǒng)的穩(wěn)定性和可靠性。
【專利說明】基于ARM9四輪快速微電腦鼠對角線沖刺系統(tǒng)
【技術(shù)領(lǐng)域】
[0001]本發(fā)明是有屬于微型機(jī)器人的【技術(shù)領(lǐng)域】，且特別是涉及一種基于ARM9四輪快速微電腦鼠對角線沖刺系統(tǒng)。
【背景技術(shù)】
[0002]微電腦鼠是使用嵌入式微控制器、傳感器和機(jī)電運(yùn)動(dòng)部件構(gòu)成的一種智能行走機(jī)器人，微電腦鼠可以在不同“迷宮”中自動(dòng)記憶和選擇路徑，采用相應(yīng)的算法，快速地到達(dá)所設(shè)定的目的地。微電腦鼠比賽在國外已經(jīng)有30幾年的歷史，現(xiàn)在每年國際上都要舉行上百場類似的微電腦鼠大賽。
[0003]微電腦鼠競賽采用運(yùn)行時(shí)間、迷宮時(shí)間和碰觸這三個(gè)參數(shù)，從速度、求解迷宮的效率和電腦鼠的可靠性三個(gè)方面來進(jìn)行評分，不同的國家采用不同的評分標(biāo)準(zhǔn)，最有代表的四個(gè)國家標(biāo)準(zhǔn)為:
美國IEEE APEC國際微電腦鼠機(jī)器人競賽 探索時(shí)間、沖刺時(shí)間和固定的接觸扣分，都記入總成績 得分=探索時(shí)間/30 +沖刺時(shí)間+固定接觸扣分 全日本國際微電腦鼠機(jī)器人大會(huì)(專家級)
總成績僅計(jì)算沖刺時(shí)間
得分=最佳沖刺時(shí)間
英國微電腦鼠機(jī)器人挑戰(zhàn)賽
探索時(shí)間、沖刺時(shí)間和可變的接觸扣分都記入總成績
得分=探索時(shí)間/30 +沖刺時(shí)間+變動(dòng)接觸扣分
新加坡機(jī)器人大賽
探索時(shí)間、沖刺時(shí)間記入總成績；每次接觸機(jī)器人將減少一次嘗試機(jī)會(huì) 得分=探索時(shí)間/30 +沖刺時(shí)間
從上面的國際標(biāo)準(zhǔn)來看，沖刺時(shí)間決定整個(gè)微電腦鼠的成敗，由于國內(nèi)研發(fā)此微電腦鼠的單位較少，相對研發(fā)水平比較落后，現(xiàn)有技術(shù)中的微電腦鼠結(jié)構(gòu)如圖1所示。長時(shí)間運(yùn)行發(fā)現(xiàn)存在著很多安全問題，包括:
(1)作為微電腦鼠的眼睛采用的是超聲波或者是一般的紅外傳感器，而且傳感器的設(shè)置有誤，使得微電腦鼠在快速?zèng)_刺時(shí)對周圍迷宮的判斷存在一定的誤判，使得微電腦在快速?zèng)_刺的時(shí)候容易撞上前方的擋墻；
(2)作為微電腦鼠的執(zhí)行機(jī)構(gòu)采用的是步進(jìn)電機(jī)，經(jīng)常會(huì)遇到丟失脈沖的問題出現(xiàn)，導(dǎo)致對沖刺位置的記憶出現(xiàn)錯(cuò)誤，有的時(shí)候找不到?jīng)_刺的終點(diǎn)；
(3)由于采用步進(jìn)電機(jī)，使得機(jī)體發(fā)熱比較嚴(yán)重，不利于在大型復(fù)雜迷宮中快速?zèng)_刺；
(4)由于采用比較低級的算法，使得最佳迷宮的計(jì)算和沖刺路徑的計(jì)算都有一定的問題，研發(fā)的微電腦鼠基本上不會(huì)多次自動(dòng)加速?zèng)_刺，在一般迷宮當(dāng)中的沖刺一般都要花費(fèi)15?30秒的時(shí)間，這使得在真正的國際復(fù)雜迷宮大賽中無法取勝； (5)由于微電腦鼠在快速?zèng)_刺過程中需要頻繁的剎車和啟動(dòng)，加重了單片機(jī)的工作量，單片信號處理器無法滿足微電腦鼠快速?zèng)_刺的要求；
(6)相對采用的都是一些體積比較大的插件元器件使得微電腦鼠的體積和重量比較龐大，而且重心較高，無法滿足快速?zèng)_刺的要求；
(7)由于受周圍環(huán)境不穩(wěn)定因素干擾，特別是周圍一些光線的干擾，單片機(jī)控制器經(jīng)常會(huì)出現(xiàn)異常，引起微電腦鼠失控，抗干擾能力較差；
(8)對于差速控制的微電腦鼠來說，一般要求其兩個(gè)電機(jī)的控制信號要同步，但是對于單一單片機(jī)來說很難辦到，使得微電腦鼠在高速?zèng)_刺時(shí)會(huì)在迷宮當(dāng)中搖擺幅度較大，經(jīng)常出現(xiàn)撞墻的現(xiàn)象發(fā)生，導(dǎo)致沖刺失??；
(9)由于受單片機(jī)容量和算法影響，微電腦鼠對迷宮的信息沒有存儲(chǔ)，當(dāng)遇到掉電情況時(shí)候所有的信息將消失，這使得整個(gè)沖刺過程無法完成；
(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ā)生，致使沖刺失敗；
(11)采用單個(gè)傳感器探知前方迷宮的擋墻，極易收到外界干擾，致使前方傳感器錯(cuò)誤引導(dǎo)快速?zèng)_刺的微電腦鼠，導(dǎo)致微電腦鼠在迷宮中沖刺不到位或者撞墻，致使沖刺失??；
(12)由于受單片機(jī)容量影響，現(xiàn)有的微電腦鼠基本上都只有兩個(gè)動(dòng)力驅(qū)動(dòng)輪，采用兩輪差速方式行駛，使得系統(tǒng)對兩軸的伺服要求較高，特別是直線加速?zèng)_刺導(dǎo)航時(shí)，要求速度和加速度要追求嚴(yán)格的一致，否則直線導(dǎo)航將會(huì)失敗，導(dǎo)致微電腦鼠出現(xiàn)撞墻的現(xiàn)象發(fā)生；
(13)兩輪微電腦鼠系統(tǒng)在加速時(shí)由于重心后移，使得老鼠前部輕飄，即使在良好的路面上微電腦鼠也會(huì)打滑，有可能導(dǎo)致撞墻的現(xiàn)象出現(xiàn)，不利于高速微電腦鼠沖刺的發(fā)展；
(14)兩輪微電腦鼠系統(tǒng)在正常行駛時(shí)如果設(shè)計(jì)不當(dāng)造成重心前偏，將導(dǎo)致驅(qū)動(dòng)輪上承受的正壓力減小，這時(shí)微電腦鼠系統(tǒng)更加容易打滑，也更容易走偏，導(dǎo)致導(dǎo)航失?。?br> (15)兩輪微電腦鼠系統(tǒng)在正常行駛時(shí)如果設(shè)計(jì)不當(dāng)造成重心側(cè)偏將導(dǎo)致兩個(gè)驅(qū)動(dòng)輪承受的正壓力不同，在快速啟動(dòng)時(shí)兩輪打滑程度不一致，瞬間就偏離軌跡，轉(zhuǎn)彎時(shí)，其中正壓力小的輪子可能打滑，導(dǎo)致轉(zhuǎn)彎困難；
(16)由于采用兩個(gè)動(dòng)力輪驅(qū)動(dòng)，為了滿足復(fù)雜狀態(tài)下的加速和減速，使得單個(gè)驅(qū)動(dòng)電機(jī)的功率較大，不僅占用的空間較大，而且有時(shí)候在一些相對需求能量較低的狀態(tài)下造成“大馬拉小車”的現(xiàn)象出現(xiàn)，不利于微電腦鼠本體微型化發(fā)展和微電腦鼠系統(tǒng)能源的節(jié)??；
綜上所述，因此需要對現(xiàn)有的基于單片機(jī)控制的微電腦鼠控制器進(jìn)行重新設(shè)計(jì)。

【發(fā)明內(nèi)容】

[0004]本發(fā)明主要解決的技術(shù)問題是提供一種基于ARM9四輪快速微電腦鼠對角線沖刺系統(tǒng)，克服單一單片機(jī)不能滿足微電腦鼠穩(wěn)定性和快速性的要求，舍棄了國產(chǎn)微電腦鼠所采用的單一單片機(jī)工作模式，在基于ARM9處理器的處理器單元中引入多軸驅(qū)動(dòng)集成芯片L298N芯片以ARM9處理器為處理核心，實(shí)現(xiàn)四軸直流電機(jī)伺服系統(tǒng)的數(shù)字信號實(shí)時(shí)處理，并實(shí)現(xiàn)兩片L298N芯片控制四臺電機(jī)的響應(yīng)中斷，實(shí)現(xiàn)數(shù)據(jù)通信和存儲(chǔ)實(shí)時(shí)信號，抗干擾能力大大增強(qiáng)，同時(shí)提高了運(yùn)算速度，保證基于ARM9四輪快速微電腦鼠對角線沖刺系統(tǒng)的穩(wěn)定性和可靠性。
[0005]為解決上述技術(shù)問題，本發(fā)明采用的一個(gè)技術(shù)方案是:提供一種基于ARM9四輪快速微電腦鼠對角線沖刺系統(tǒng)，包括處理器單兀、電機(jī)X、電機(jī)Y、電機(jī)Z、電機(jī)R以及微電腦鼠機(jī)械裝置，所述的處理器單元分別與電機(jī)X、電機(jī)Y、電機(jī)Z以及電機(jī)R進(jìn)行電性連接，所述的電機(jī)X、電機(jī)Y、電機(jī)Z以及電機(jī)R與微電腦鼠機(jī)械裝置進(jìn)行連接，其中，所述的處理器單元包括ARM9處理器和L298N芯片，所述的ARM9處理器和L298N芯片進(jìn)行電性連接。
[0006]在本發(fā)明一個(gè)較佳實(shí)施例中，所述的處理器單元分別發(fā)出第一控制信號、第二控制信號、第三控制信號以及第四控制信號，由第一控制信號、第二控制信號、第三控制信號以及第四控制信號分別對應(yīng)控制電機(jī)X、電機(jī)Y、電機(jī)Z以及電機(jī)R。
[0007]在本發(fā)明一個(gè)較佳實(shí)施例中，所述的處理器單元還包括設(shè)于ARM9處理器和L298N芯片的上位機(jī)系統(tǒng)和運(yùn)動(dòng)控制系統(tǒng)，所述的上位機(jī)系統(tǒng)包括迷宮讀取模塊、坐標(biāo)定位模塊以及在線輸出模塊，所述的運(yùn)動(dòng)控制系統(tǒng)包括伺服控制模塊、數(shù)據(jù)存儲(chǔ)模塊以及I/O控制模塊，其中，所述的迷宮讀取模塊、坐標(biāo)定位模塊、在線輸出模塊、數(shù)據(jù)存儲(chǔ)模塊以及I/o控制模塊分別與所述的L298N芯片進(jìn)行電性連接。
[0008]在本發(fā)明一個(gè)較佳實(shí)施例中，所述的伺服控制模塊還包括電流模塊、速度模塊以及坐標(biāo)模塊，所述的控制伺服控制模塊與所述的ARM9處理器進(jìn)行電性連接。
[0009]在本發(fā)明一個(gè)較佳實(shí)施例中，所述的微電腦鼠連轉(zhuǎn)沖刺系統(tǒng)還包括電池，所述的電池與所述的處理器單元進(jìn)行電性連接。
[0010]在本發(fā)明一個(gè)較佳實(shí)施例中，所述的電池為鋰離子電池。
[0011 ] 在本發(fā)明一個(gè)較佳實(shí)施例中，所述的電機(jī)X、電機(jī)Y、電機(jī)Z和電機(jī)R均為高速永磁直流電機(jī)。
[0012]在本發(fā)明一個(gè)較佳實(shí)施例中，所述的電機(jī)X、電機(jī)Y、電機(jī)Z和電機(jī)R的轉(zhuǎn)軸上均設(shè)有光電編碼器。
[0013]在本發(fā)明一個(gè)較佳實(shí)施例中，所述的微電腦鼠機(jī)械裝置上設(shè)有光電傳感器、電壓傳感器以及六個(gè)屏蔽傳感器，所述光電傳感器、電壓傳感器以及屏蔽傳感器分別與所述的處理器單元進(jìn)行電性連接。
[0014]在本發(fā)明一個(gè)較佳實(shí)施例中，所述的微電腦鼠機(jī)械裝置上設(shè)有兩片陀螺儀，所述的陀螺儀與所述的處理器單元進(jìn)行電性連接。
[0015]本發(fā)明的基于ARM9四輪快速微電腦鼠對角線沖刺系統(tǒng)，克服單一單片機(jī)不能滿足微電腦鼠穩(wěn)定性和快速性的要求，舍棄了國產(chǎn)微電腦鼠所采用的單一單片機(jī)工作模式，在基于ARM9處理器的處理器單元中引入多軸驅(qū)動(dòng)集成芯片L298N芯片以ARM9處理器為處理核心，實(shí)現(xiàn)四軸直流電機(jī)伺服系統(tǒng)的數(shù)字信號實(shí)時(shí)處理，并實(shí)現(xiàn)兩片L298N芯片控制四臺電機(jī)的響應(yīng)中斷，實(shí)現(xiàn)數(shù)據(jù)通信和存儲(chǔ)實(shí)時(shí)信號，抗干擾能力大大增強(qiáng)，同時(shí)提高了運(yùn)算速度，保證基于ARM9四輪快速微電腦鼠對角線沖刺系統(tǒng)的穩(wěn)定性和可靠性。
【專利附圖】

【附圖說明】
[0016]為了更清楚地說明本發(fā)明實(shí)施例中的技術(shù)方案，下面將對實(shí)施例描述中所需要使用的附圖作簡單地介紹，顯而易見地，下面描述中的附圖僅僅是本發(fā)明的一些實(shí)施例，對于本領(lǐng)域普通技術(shù)人員來講，在不付出創(chuàng)造性勞動(dòng)的前提下，還可以根據(jù)這些附圖獲得其它的附圖，其中:
圖1為現(xiàn)有技術(shù)的微電腦鼠系統(tǒng)的電路圖；
圖2為本發(fā)明較佳實(shí)施例的基于ARM9四輪快速微電腦鼠對角線沖刺系統(tǒng)的電路圖； 圖3為圖2中處理器單元的內(nèi)部系統(tǒng)結(jié)構(gòu)框圖；
圖4為本發(fā)明較佳實(shí)施例的微電腦鼠迷宮示意圖；
圖5為本發(fā)明較佳實(shí)施例的微電腦鼠的結(jié)構(gòu)示意圖；
圖6為微電腦鼠速度曲線圖；
圖7微電腦鼠自動(dòng)沖刺程序示意圖；
圖8為微電腦鼠右轉(zhuǎn)沖刺示意圖；
圖9為微電腦鼠左轉(zhuǎn)沖刺意義圖；
圖10為樓梯迷宮；
圖11為45度沖刺樓梯示意圖；
圖12為連轉(zhuǎn)M型迷宮；
圖13為連轉(zhuǎn)M型示意圖；
圖14為連轉(zhuǎn)M型參數(shù)示意圖；
圖15為本發(fā)明較佳實(shí)施例的基于ARM9四輪快速微電腦鼠對角線沖刺系統(tǒng)控制示意
圖；
附圖5中各部件的標(biāo)記如下:1、微電腦鼠，2、車輪,3、蔽障傳感器,4、光電補(bǔ)償傳感器，
5、電壓傳感器。
【具體實(shí)施方式】
[0017]下面將對本發(fā)明實(shí)施例中的技術(shù)方案進(jìn)行清楚、完整地描述，顯然，所描述的實(shí)施例僅是本發(fā)明的一部分實(shí)施例，而不是全部的實(shí)施例?；诒景l(fā)明中的實(shí)施例，本領(lǐng)域普通技術(shù)人員在沒有做出創(chuàng)造性勞動(dòng)前提下所獲得的所有其它實(shí)施例，都屬于本發(fā)明保護(hù)的范圍。
[0018]請參閱圖2至圖15,本發(fā)明實(shí)施例包括:
一種基于ARM9四輪快速微電腦鼠對角線沖刺系統(tǒng),包括處理器單兀、電機(jī)X、電機(jī)Y、電機(jī)Z、電機(jī)R以及微電腦鼠機(jī)械裝置，所述的處理器單元分別與電機(jī)X、電機(jī)Y、電機(jī)Z以及電機(jī)R進(jìn)行電性連接，所述的電機(jī)X、電機(jī)Y、電機(jī)Z以及電機(jī)R與微電腦鼠機(jī)械裝置進(jìn)行連接，其中，所述的處理器單元包括ARM9處理器和L298N芯片，所述的ARM9處理器和L298N芯片進(jìn)行電性連接。
[0019]上述中，所述的處理器單元分別發(fā)出第一控制信號、第二控制信號、第三控制信號以及第四控制信號，由第一控制信號、第二控制信號、第三控制信號以及第四控制信號分別對應(yīng)控制電機(jī)X、電機(jī)Y、電機(jī)Z以及電機(jī)R。
[0020]所述的微電腦鼠連轉(zhuǎn)沖刺系統(tǒng)還包括電池，所述的電池與所述的處理器單元進(jìn)行電性連接。其中，所述的電池為鋰離子電池，是一種供電裝置，為整個(gè)系統(tǒng)的工作提供工作電壓。
[0021]進(jìn)一步的，所述的電機(jī)X、電機(jī)Y、電機(jī)Z和電機(jī)R均為高速永磁直流電機(jī)。其中，所述的電機(jī)X、電機(jī)Y、電機(jī)Z和電機(jī)R的轉(zhuǎn)軸上均設(shè)有光電編碼器。[0022]其工作原理為:由電池為整個(gè)系統(tǒng)的工作提供工作電壓，處理器單元分別發(fā)出第一控制信號、第二控制信號、第三控制信號以及第四控制信號，由第一控制信號、第二控制信號、第三控制信號以及第四控制信號分別對應(yīng)控制電機(jī)X、電機(jī)Y、電機(jī)Z以及電機(jī)R，通過所述的電機(jī)X的第一控制信號、通過所述的電機(jī)Y的第二控制信號、通過所述的電機(jī)Z的第三控制信號和通過所述的電機(jī)R的第四控制信號經(jīng)過合成之后，控制微電腦鼠機(jī)械裝置的運(yùn)動(dòng)。
[0023]本發(fā)明中，所述的處理器單元包括ARM9處理器和L298N芯片，所述的ARM9處理器和L298N芯片進(jìn)行電性連接。
[0024]ARM9 處理器米用 R I SC ( Reduce Instruction Computer，精簡指令集計(jì)算機(jī))結(jié)構(gòu)，具有寄存器多、尋址方式簡單、批量傳輸數(shù)據(jù)、使用地址自動(dòng)增減等特點(diǎn)。新一代的ARM9處理器，通過全新的設(shè)計(jì)，采用了更多的晶體管，能夠達(dá)到兩倍以上于ARM7處理器的處理能力。這種處理能力的提高是通過增加時(shí)鐘頻率和減少指令執(zhí)行周期實(shí)現(xiàn)的。
[0025]S3C2440A采用ARM920T內(nèi)核，其主要特點(diǎn)有:
(1)1.2V 內(nèi)核，1.8V/2.5V/3.3V 儲(chǔ)存器，3.3V 擴(kuò)展 I/O, 16KB 指令 Cache (1-Cache)/16KB 數(shù)據(jù) Cache (D-Cache)；
(2)3 路 URAT ；
(3)4路PWM定時(shí)器/I路內(nèi)部定時(shí)器/看門狗定時(shí)器；
(4)8路10位ADC和觸摸屏接口 ；
(5)130個(gè)通用1/0，24個(gè)外部中斷源；
(6)32bit定點(diǎn)RISC處理器，改進(jìn)型ARM/ Thumb代碼交織，增強(qiáng)性乘法器設(shè)計(jì)。支持實(shí)時(shí)(real-time)調(diào)試；
(7)片內(nèi)指令和數(shù)據(jù)SRAM，而且指令和數(shù)據(jù)的存儲(chǔ)器容量可調(diào)；
(8)片內(nèi)指令和數(shù)據(jù)高速緩沖器(cache)容量從4K字節(jié)到IM字節(jié)；
(9)設(shè)置保護(hù)單元(protectionunit)，非常適合嵌入式應(yīng)用中對存儲(chǔ)器進(jìn)行分段和保
護(hù)；
(10)采用AMBAAHB總線接口，為外設(shè)提供統(tǒng)一的地址和數(shù)據(jù)總線；
(11)支持外部協(xié)處理器，指令和數(shù)據(jù)總線有簡單的握手信令支持；
(12)支持標(biāo)準(zhǔn)基本邏輯單元掃描測試方法學(xué)，而且支持BIST(built-1n-self-test)；
(13)支持嵌入式跟蹤宏單元，支持實(shí)時(shí)跟蹤指令和數(shù)據(jù)。
[0026]L298N芯片是SGS公司的產(chǎn)品，比較常見的是20管腳PowerS020封裝。內(nèi)部包含4通道邏輯驅(qū)動(dòng)電路，可以方便的驅(qū)動(dòng)兩個(gè)直流電機(jī)，輸出電壓最高可達(dá)50V，可以直接通過電源來調(diào)節(jié)輸出電壓。L298N芯片的6腳VS接電源電壓，VS電壓范圍為+ 2.5~46 V，輸出電流可達(dá)2.5 A，可驅(qū)動(dòng)電感性負(fù)載。2腳和19腳下管的發(fā)射極分別單獨(dú)引出以便接入電流采樣電阻，形成電流傳感信號。其中一片L298N芯片的的8腳和14腳ΕηΑ,ΕηΒ是使能控制端，分別控制電機(jī)X和 電機(jī)Y的停轉(zhuǎn)。L298N芯片的7，9，13，15腳接ARM9 (S3C2440A)的輸入腳，由ARM9 (S3C2440A)控制0UT1，0UT2和0UT3，0UT4的電平，來控制電機(jī)X和電機(jī)Y的正反轉(zhuǎn)；另外一片L298N芯片的的8腳和14腳ΕηΑ,ΕηΒ分別控制電機(jī)Z和電機(jī)R的停轉(zhuǎn)。L298N芯片的7，9，13，15腳接々觀9 (S3C2440A)的輸入腳，由ARM9 (S3C2440A)控制OUT I, OUT2和OUT3，0UT4的電平，來控制電機(jī)Z和電機(jī)R的正反轉(zhuǎn)。
[0027]進(jìn)一步的，所述的處理器單元還包括設(shè)于ARM9處理器和L298N芯片的上位機(jī)系統(tǒng)和運(yùn)動(dòng)控制系統(tǒng)，所述的上位機(jī)系統(tǒng)包括迷宮讀取模塊、坐標(biāo)定位模塊以及在線輸出模塊，所述的運(yùn)動(dòng)控制系統(tǒng)包括伺服控制模塊、數(shù)據(jù)存儲(chǔ)模塊以及I/O控制模塊。
[0028]其中，所述的迷宮讀取模塊、坐標(biāo)定位模塊、在線輸出模塊、數(shù)據(jù)存儲(chǔ)模塊以及I/O控制模塊分別與所述的L298N芯片進(jìn)行電性連接；所述的控制伺服控制模塊與所述ARM9處理器進(jìn)行電性連接。
[0029]迷宮讀取模塊將已經(jīng)預(yù)設(shè)好的迷宮進(jìn)行調(diào)出；坐標(biāo)定位模用于提示微電腦鼠的位置以及位置參數(shù)設(shè)置等；在線輸出模塊用于提示微電腦鼠的工作狀態(tài)；數(shù)據(jù)存儲(chǔ)模塊為一存儲(chǔ)器；1/0控制模塊包括RS-232串行接口、ICE端口等。所述的伺服控制模塊進(jìn)一步包括電流模塊、速度模塊以及坐標(biāo)模塊。其中，電流模塊與電池和處理器單元連接，電流模塊用于調(diào)整電池的供電功率達(dá)到微電腦鼠需要的范圍；速度模塊用來調(diào)節(jié)微電腦鼠實(shí)際轉(zhuǎn)速；坐標(biāo)模塊用于檢測微電腦鼠的坐標(biāo)位置，接到處理器單元發(fā)出的沖刺命令后，會(huì)沿著起點(diǎn)開始快速向終點(diǎn)沖刺。
[0030]基于ARM9處理器的處理器單元，把微電腦鼠放在迷宮起始點(diǎn)，在電源打開狀態(tài)下，微電腦鼠先進(jìn)入自鎖狀態(tài)，然后ARM9處理器會(huì)根據(jù)按鍵信息重新搜索并優(yōu)化迷宮或者是自動(dòng)調(diào)取存儲(chǔ)的迷宮信息并計(jì)算出沖刺路徑，微電腦鼠依靠前方、左右側(cè)面蔽障傳感器根據(jù)實(shí)際導(dǎo)航環(huán)境傳輸參數(shù)給控制器中的ARM9處理器，ARM9處理器處理后使能L298N芯片，然后由L298N芯片生成四路PWM波驅(qū)動(dòng)四個(gè)獨(dú)立電機(jī)并實(shí)現(xiàn)其快速?zèng)_刺時(shí)的伺服控制，最后把處理數(shù)據(jù)通訊給ARM9處理器，由ARM9處理器繼續(xù)處理后續(xù)的運(yùn)行狀態(tài)。
[0031]結(jié)合以上描述，所述的L298N芯片用于控制迷宮讀取模塊、坐標(biāo)定位模塊、在線輸出模塊、數(shù)據(jù)存儲(chǔ)模塊以及I/o控制模塊，ARM9處理器用于控制伺服控制模塊，這樣就實(shí)現(xiàn)了 ARM9處理器與L298N芯片的分工，把L298N芯片從復(fù)雜的工作當(dāng)中解脫出來，且ARM9處理器和L298N芯片之間也可以進(jìn)行通訊，實(shí)時(shí)進(jìn)行數(shù)據(jù)交換和調(diào)用。
[0032]本發(fā)明為了克服單一單片機(jī)不能滿足基于ARM9四輪快速微電腦鼠對角線沖刺系統(tǒng)的穩(wěn)定性和快速性的要求，舍棄了國產(chǎn)微電腦鼠所采用的單一單片機(jī)工作模式，在基于ARM9處理器的處理器單元中引入多軸驅(qū)動(dòng)集成芯片L298N芯片以ARM9處理器為處理核心，實(shí)現(xiàn)四軸直流電機(jī)伺服系統(tǒng)的數(shù)字信號實(shí)時(shí)處理，并實(shí)現(xiàn)兩片L298N芯片控制四臺電機(jī)的響應(yīng)中斷，實(shí)現(xiàn)數(shù)據(jù)通信和存儲(chǔ)實(shí)時(shí)信號。
[0033]在本實(shí)施例中，所述微電腦鼠I上設(shè)有六個(gè)紅外傳感器0PE5594A作為蔽障傳感器3，每一個(gè)蔽障傳感器3分別與所述處理器單元進(jìn)行電性連接，將六個(gè)蔽障傳感器3分別編號為S1、S2、S3、S4、S5、S6，其中，蔽障傳感器SI和蔽障傳感器S6的信號發(fā)射方向與所述車輪2的運(yùn)動(dòng)方向相同，蔽障傳感器S2和蔽障傳感器S5的信號發(fā)射方向相反且垂直于所述車輪2的運(yùn)動(dòng)方向，蔽障傳感器S3和蔽障傳感器S4與所述車輪2的運(yùn)動(dòng)方向的夾角為一般為45度。
[0034]進(jìn)一步的，所述微電腦鼠I包括電壓傳感器5和光電傳感器4，所述電壓傳感器5和光電傳感器4分別與所述處理器單元進(jìn)行電性連接，所述電壓傳感器5編號為S8，所述光電傳感器4編號為S7。
[0035]再進(jìn)一步的，所述的微電腦鼠I上還設(shè)有兩片陀螺儀(圖未視)，所述的陀螺儀與所述的處理器單元進(jìn)行電性連接。
[0036]其具體功能實(shí)現(xiàn)如下:
1)在微電腦鼠打開電源瞬間，系統(tǒng)將會(huì)按照圖7的方式完成沖刺，首先系統(tǒng)要完成初始化，然后等待按鍵信息，未接到按鍵信息命令之前，它一般會(huì)在起點(diǎn)坐標(biāo)(0，O)等待控制器發(fā)出的沖刺命令，根據(jù)按鍵信息，本發(fā)明有多種沖刺方法:如果按下的是START(啟動(dòng))鍵，說明系統(tǒng)要放棄以前的迷宮信息先進(jìn)行搜索，然后搜索完成后生成優(yōu)化的沖刺迷宮信息，微電腦鼠進(jìn)入自動(dòng)多次沖刺階段；如果按下的是RESET (復(fù)位)+STRAT (啟動(dòng))鍵，說明系統(tǒng)要調(diào)出已經(jīng)探索后的最優(yōu)迷宮，然后沿著起點(diǎn)開始快速向終點(diǎn)(7，7)、(7，8)、(8，7)、(8，8)沖刺；如果按下的是RESET (復(fù)位)+STRAT (啟動(dòng))+SPEED (速度)鍵，說明系統(tǒng)要調(diào)出已經(jīng)探索后的最優(yōu)迷宮，然后沿著起點(diǎn)以設(shè)定的沖刺速度開始快速向終點(diǎn)(7，7)、(7，8)、(8，7)、(8，8)沖刺；
2)微電腦鼠放在起點(diǎn)坐標(biāo)(0，0)，接到任務(wù)后為了防止放錯(cuò)沖刺方向，其前方的傳感器S1、S6和會(huì)對前方的環(huán)境進(jìn)行判斷，確定有沒有擋墻進(jìn)入運(yùn)動(dòng)范圍，如存在擋墻將向ARM9處理器發(fā)出中斷請求，ARM9處理器會(huì)對中斷做第一時(shí)間響應(yīng)，然后禁止L298N芯片的使能端ENA和ENB工作，封鎖微電腦鼠的電機(jī)X、電機(jī)Y、電機(jī)Z和電機(jī)R的PWM驅(qū)動(dòng)信號，使其靜止在原地，然后二次判斷迷宮確定前方信息，防止信息誤判；如果沒有擋墻進(jìn)入前方的運(yùn)動(dòng)范圍，微電腦鼠將進(jìn)行正常的沖刺；
3)本發(fā)明舍棄了傳統(tǒng)單一速度沖刺模式，按照圖6的速度和時(shí)間曲線控制微電腦鼠的加速和減速，梯形圖包含的面積為微電腦鼠運(yùn)動(dòng)的距離，在微電腦鼠沿著Y軸向前快速?zèng)_刺過程中如果迷宮信息中顯示前方有Z格直線坐標(biāo)下沒有擋墻進(jìn)入前方的運(yùn)動(dòng)范圍，系統(tǒng)進(jìn)入沖刺子程序1，微電腦鼠將存儲(chǔ)其現(xiàn)在的坐標(biāo)(X，Y)，處理器把向前運(yùn)動(dòng)Z格的位置參數(shù)傳遞給ARM9處理器，ARM9處理器根據(jù)此位置參數(shù)，計(jì)算出速度參數(shù)以及加速度參數(shù)，形成此時(shí)條件下的速度-時(shí)間梯形圖，由于直流電機(jī)的速度和電壓成正比例，根據(jù)這個(gè)梯形圖圖結(jié)合光電編碼器和電流傳感器的反饋就可以生成控制左右輪直流電機(jī)的PWM波，然后ARM9處理器使能前驅(qū)和后驅(qū)的兩片驅(qū)動(dòng)芯片L298N芯片，通過調(diào)整兩片L298N芯片管腳0UT1、0UT2和0UT3、0UT4的電平，啟動(dòng)電機(jī)X、電機(jī)Y、電機(jī)Z和電機(jī)R，使系統(tǒng)按照圖6的速度-時(shí)間運(yùn)動(dòng)圖進(jìn)入加速階段，直到系統(tǒng)到達(dá)設(shè)定直線沖刺速度，并通過光電編碼器記錄下微電腦鼠已經(jīng)運(yùn)行的距離SI ;如果地面不易打滑，ARM9處理器會(huì)禁止前驅(qū)的驅(qū)動(dòng)芯片L298N芯片使能，系統(tǒng)釋放電機(jī)Z和電機(jī)R，微電腦鼠進(jìn)入后驅(qū)方式，電機(jī)X和電機(jī)Y以設(shè)定的直線沖刺速度到達(dá)指定位置S1+S2，然后系統(tǒng)使能前驅(qū)的驅(qū)動(dòng)芯片L298N芯片，使電機(jī)X、電機(jī)Y、電機(jī)Z和電機(jī)R以相同的加速度驅(qū)動(dòng)微電腦鼠開始減速，直至到達(dá)設(shè)定目標(biāo)S1+S2+S1，將更新其坐標(biāo)為(X，Y+Z)，為了快速?zèng)_刺需要，在其向前運(yùn)動(dòng)過程到達(dá)既定目標(biāo)時(shí)，在Y+Z〈15的前提下，判斷其坐標(biāo)是不是(7，7)、(7，8)、(8，7)、(8，8)其中的一個(gè)，如果不是將繼續(xù)更新其坐標(biāo)，如果是的話通知控制器已經(jīng)沖刺到目標(biāo)，然后置返航探索標(biāo)志為1，沖刺標(biāo)志為0，微電腦鼠準(zhǔn)備沖刺后的二次返程探索，去搜尋更優(yōu)的迷宮路徑；
4)在微電腦鼠沿著Y軸反向向前快速?zèng)_刺過程中如果迷宮信息中顯示前方有Z格直線坐標(biāo)下沒有擋墻進(jìn)入前方的運(yùn)動(dòng)范圍，系統(tǒng)進(jìn)入沖刺子程序1，微電腦鼠將存儲(chǔ)其現(xiàn)在的坐標(biāo)(X，Y)，處理器把向前運(yùn)動(dòng)Z格的位置參數(shù)傳遞給ARM9處理器，ARM9處理器根據(jù)此位置參數(shù)，計(jì)算出速度參數(shù)以及加速度參數(shù)，形成此時(shí)條件下的速度時(shí)間梯形圖，由于直流電機(jī)的速度和電壓成正比例，根據(jù)這個(gè)梯形圖圖結(jié)合光電編碼器和電流傳感器的反饋就可以生成控制左右輪直流電機(jī)的PWM波，然后ARM9處理器使能前驅(qū)和后驅(qū)的兩片驅(qū)動(dòng)芯片L298N芯片，通過調(diào)整兩片L298N芯片管腳0UT1、0UT2和0UT3、0UT4的電平，啟動(dòng)電機(jī)X、電機(jī)Y、電機(jī)Z和電機(jī)R，使系統(tǒng)進(jìn)入加速階段，直到系統(tǒng)到達(dá)設(shè)定直線沖刺速度，并通過光電編碼器記錄下微電腦鼠已經(jīng)運(yùn)行的距離SI ;然后ARM9處理器禁止前驅(qū)的驅(qū)動(dòng)芯片L298N芯片使能，系統(tǒng)釋放電機(jī)Z和電機(jī)R,微電腦鼠進(jìn)入后驅(qū)方式，電機(jī)X和電機(jī)Y以設(shè)定的直線沖刺速度到達(dá)指定位置S1+S2，然后系統(tǒng)使能前驅(qū)的驅(qū)動(dòng)芯片L298N芯片，使電機(jī)X、電機(jī)Y、電機(jī)Z和電機(jī)R以相同的加速度驅(qū)動(dòng)微電腦鼠開始減速，直至?xí)r到達(dá)設(shè)定目標(biāo)S1+S2+S1，將更新其坐標(biāo)為(X，Y-Z )，為了快速?zèng)_刺需要，在其向前運(yùn)動(dòng)過程到達(dá)既定目標(biāo)時(shí)，在Y-Z〈 15的前提下，判斷其坐標(biāo)是不是(7，7)、(7，8)、(8，7)、(8，8)其中的一個(gè)，如果不是將繼續(xù)更新其坐標(biāo)，如果是的話通知控制器已經(jīng)沖刺到目標(biāo)，然后置返航探索標(biāo)志為1，沖刺標(biāo)志為O，微電腦鼠準(zhǔn)備沖刺后的二次返程探索，去搜尋更優(yōu)的迷宮路徑；
5)在微電腦鼠沿著Y軸向前運(yùn)動(dòng)過程中如果有迷宮擋墻進(jìn)入前方的運(yùn)動(dòng)范圍，并且此時(shí)迷宮信息中左方有擋墻右方無擋墻時(shí)，微電腦鼠將存儲(chǔ)此時(shí)坐標(biāo)(X，Y)，然后進(jìn)入圖8所示的曲線運(yùn)動(dòng)軌跡，系統(tǒng)進(jìn)入沖刺子程序2，在右沖刺轉(zhuǎn)彎時(shí)，ARM9處理器首先把行走直線很短的距離Leading按照各種沖刺條件不同的要求轉(zhuǎn)化為速度參數(shù)以及加速度參數(shù)指令值，然后結(jié)合光電編碼器和電流傳感器的反饋經(jīng)內(nèi)部位置、速度和加速度控制程序，生成控制前后左右四輪的PWM波給L298N芯片，然后控制左右輪以相同的加速度和速度控制電機(jī)X、電機(jī)Y、電機(jī)Z和電機(jī)R向前快速運(yùn)動(dòng)；當(dāng)?shù)竭_(dá)既定目標(biāo)時(shí)，傳感器參考值R90_FrontffallRef開始工作，防止外界干擾開始做誤差補(bǔ)償，誤差補(bǔ)償結(jié)束后，ARM9處理器把行走的曲線軌跡R_Arcl和R_Arc3按照各種沖刺條件不同的要求轉(zhuǎn)化為速度參數(shù)以及加速度參數(shù)指令值，然后結(jié)合光電編碼器和電流傳感器的反饋經(jīng)內(nèi)部位置、速度和加速度控制程序，生成控制前后左右四輪的PWM波給L298N芯片，控制前后左右四輪工作；當(dāng)?shù)竭_(dá)既定目標(biāo)后，ARM9處理器把行走的曲線軌跡R_Arc2和R_Arc4按照各種沖刺條件不同的要求轉(zhuǎn)化為后驅(qū)和前驅(qū)的四輪速度參數(shù)以及加速度參數(shù)指令值，然后結(jié)合光電編碼器和電流傳感器的反饋經(jīng)內(nèi)部位置、速度和加速度控制程序，生成控制前后左右四輪的PWM波給L298N芯片，控制前后左右四輪工作；當(dāng)?shù)竭_(dá)既定目標(biāo)后，微電腦鼠在陀螺儀的控制下已經(jīng)右轉(zhuǎn)90度，控制器把直線行走很短的距離Passing按照各種沖刺條件不同的要求轉(zhuǎn)化為速度參數(shù)以及加速度參數(shù)指令值，然后結(jié)合光電編碼器和電流傳感器的反饋經(jīng)內(nèi)部位置、速度和加速度控制程序，生成控制前后左右四輪的PWM波給L298N芯片，控制電機(jī)X、電機(jī)Y、電機(jī)Z和電機(jī)R向前快速運(yùn)動(dòng)，當(dāng)?shù)竭_(dá)既定目標(biāo)后完成整個(gè)右轉(zhuǎn)彎的軌跡曲線運(yùn)動(dòng)，此時(shí)將更新其坐標(biāo)為(X+1，Y)，在X+l〈15的前提下，判斷其坐標(biāo)是不是(7，7)、(7，8)、(8，7)、(8，8)其中的一個(gè)，如果不是將繼續(xù)更新其坐標(biāo)，如果是的話通知控制器已經(jīng)沖刺到目標(biāo)，然后置返航探索標(biāo)志為1，沖刺標(biāo)志為0，微電腦鼠準(zhǔn)備沖刺后的二次返程探索，去搜尋更優(yōu)的迷宮路徑；
6)在微電腦鼠沿著Y軸向前運(yùn)動(dòng)過程中如果有迷宮擋墻進(jìn)入前方的運(yùn)動(dòng)范圍，并且此時(shí)迷宮信息中右方有擋墻左方無擋墻時(shí)，微電腦鼠將存儲(chǔ)此時(shí)坐標(biāo)(X，Y)，然后進(jìn)入圖9所示的曲線運(yùn)動(dòng)軌跡，系統(tǒng)進(jìn)入沖刺子程序3，在左沖刺轉(zhuǎn)彎時(shí)，ARM9處理器首先把行走直線很短的距離Leading按照各種沖刺條件不同的要求轉(zhuǎn)化為速度參數(shù)以及加速度參數(shù)指令值，然后結(jié)合光電編碼器和電流傳感器的反饋經(jīng)內(nèi)部位置、速度和加速度控制程序，生成控制前后左右四輪的PWM波給L298N芯片，然后控制左右輪以相同的加速度和速度控制電機(jī)X、電機(jī)Y、電機(jī)Z和電機(jī)R向前快速運(yùn)動(dòng)；當(dāng)?shù)竭_(dá)既定目標(biāo)時(shí)，傳感器參考值L90_FrontffallRef開始工作，防止外界干擾開始做誤差補(bǔ)償，誤差補(bǔ)償結(jié)束后，ARM9處理器把行走的曲線軌和L_Arc3按照各種沖刺條件不同的要求轉(zhuǎn)化為速度參數(shù)以及加速度參數(shù)指令值，然后結(jié)合光電編碼器和電流傳感器的反饋經(jīng)內(nèi)部位置、速度和加速度控制程序，生成控制前后左右四輪的PWM波給L298N芯片，控制前后左右四輪工作；當(dāng)?shù)竭_(dá)既定目標(biāo)后，ARM9處理器把行走的曲線軌跡L_Arc2和L_Arc4按照各種沖刺條件不同的要求轉(zhuǎn)化為后驅(qū)和前驅(qū)的四輪速度參數(shù)以及加速度參數(shù)指令值，然后結(jié)合光電編碼器和電流傳感器的反饋經(jīng)內(nèi)部位置、速度和加速度控制程序，生成控制前后左右四輪的PWM波給L298N芯片，控制前后左右四輪工作；當(dāng)?shù)竭_(dá)既定目標(biāo)后，微電腦鼠在陀螺儀的控制下已經(jīng)左轉(zhuǎn)90度，控制器把直線行走很短的距離Passing按照各種沖刺條件不同的要求轉(zhuǎn)化為速度參數(shù)以及加速度參數(shù)指令值，然后結(jié)合光電編碼器和電流傳感器的反饋經(jīng)內(nèi)部位置、速度和加速度控制程序，生成控制前后左右四輪的PWM波給L298N芯片，控制電機(jī)X、電機(jī)Y、電機(jī)Z和電機(jī)R向前快速運(yùn)動(dòng)，當(dāng)?shù)竭_(dá)既定目標(biāo)后完成整個(gè)右轉(zhuǎn)彎的軌跡曲線運(yùn)動(dòng)，此時(shí)將更新其坐標(biāo)為(X-1，Y)，在X-1X)的前提下，判斷其坐標(biāo)是不是(7，7)、(7，8)、(8，7)、(8，8)其中的一個(gè)，如果不是將繼續(xù)更新其坐標(biāo)，如果是的話通知控制器已經(jīng)沖刺到目標(biāo)，然后置返航探索標(biāo)志為1，沖刺標(biāo)志為0，微電腦鼠準(zhǔn)備沖刺后的二次返程探索，去搜尋更優(yōu)的迷宮路徑；
7)在微電腦鼠沿著X軸、Y軸向前運(yùn)動(dòng)過程中如果有類似圖10的樓梯型迷宮擋墻進(jìn)入前方的運(yùn)動(dòng)范圍，系統(tǒng)進(jìn)入沖刺子程序4，微電腦鼠將存儲(chǔ)此時(shí)坐標(biāo)(X，Y)，然后進(jìn)入圖11所示的對角線運(yùn)動(dòng)軌跡，在直道坐標(biāo)為(X，Y)時(shí)，ARM9處理器控制電機(jī)X、電機(jī)Y、電機(jī)Z和電機(jī)R以相同的速度勻速前進(jìn)，在前進(jìn)過程中傳感器S2、S3和S4、S5共同作用，保證微電腦鼠沖刺的時(shí)候一定沿著迷宮中線行駛，即將沖出坐標(biāo)為(X，Y)迷宮方格時(shí)，微電腦鼠前方傳感器SI和S6將工作，當(dāng)讀到預(yù)設(shè)值時(shí)，說明微電腦鼠的前部已經(jīng)進(jìn)入坐標(biāo)(X+1，Y)，然后把微電腦鼠傳感器SI到電機(jī)中心的距離SX傳輸給ARM9處理器，ARM9處理器首先把行走直線很短的距離SX按照不同的沖刺條件時(shí)間要求轉(zhuǎn)化為速度參數(shù)以及加速度參數(shù)指令值，然后結(jié)合電機(jī)X、電機(jī)Y、電機(jī)Z和電機(jī)R上的光電編碼器和電流傳感器的反饋經(jīng)內(nèi)部位置、速度和加速度控制程序，生成控制前后左右四輪的PWM波給L298N芯片，然后控制四輪以相同的加速度和速度直線前進(jìn)；當(dāng)?shù)竭_(dá)既定目標(biāo)時(shí)，把此時(shí)的迷宮坐標(biāo)更新為(X+1，Y);此刻微電腦鼠開始為45度對角線沖刺做姿態(tài)調(diào)整，控制器會(huì)把曲線運(yùn)動(dòng)軌跡L_Arcl_45和L_Arc3_45按照不同的沖刺條件時(shí)間要求轉(zhuǎn)化為速度參數(shù)以及加速度參數(shù)指令值，然后結(jié)合電機(jī)X、電機(jī)Y、電機(jī)Z和電機(jī)R上的光電編碼器和電流傳感器的反饋經(jīng)內(nèi)部位置、速度和加速度控制程序，生成控制前后左右四輪的PWM波給L298N芯片，然后控制左右輪以恒定的比值前進(jìn)；當(dāng)?shù)竭_(dá)既定目標(biāo)后，立即調(diào)整微電腦鼠前后左右四輪的速度，控制器把曲線運(yùn)動(dòng)軌跡L-Arc2_45和L_Arc4_45按照不同的沖刺條件時(shí)間要求轉(zhuǎn)化為速度參數(shù)以及加速度參數(shù)指令值，然后結(jié)合電機(jī)X、電機(jī)Y、電機(jī)Z和電機(jī)R上的光電編碼器和電流傳感器的反饋經(jīng)內(nèi)部位置、速度和加速度控制程序，生成控制前后左右四輪的PWM波給L298N芯片，然后控制左右輪以恒定的比值前進(jìn)；在陀螺儀的控制下，保證到達(dá)當(dāng)?shù)竭_(dá)既定目標(biāo)A點(diǎn)時(shí)曲線L_△此2_45和1^_4此4_45的斜率為45度，然后控制器把直線行走很短的距離Passingl按照不同的沖刺條件時(shí)間要求轉(zhuǎn)化為速度參數(shù)以及加速度參數(shù)指令值，然后結(jié)合電機(jī)X、電機(jī)Y、電機(jī)Z和電機(jī)R上的光電編碼器和電流傳感器的反饋經(jīng)內(nèi)部位置、速度和加速度控制程序，生成控制左右輪的PWM波給L298N芯片，然后控制前后左右四輪以相同的加速度和速度前進(jìn)，當(dāng)?shù)竭_(dá)既定目標(biāo)后通過三段不同的軌跡完成整個(gè)左轉(zhuǎn)彎45度方向的改變，微電腦鼠進(jìn)入對角線沖刺階段，此時(shí)前方傳感器SI和S6開始工作；ARM9處理器首先把行走直線距離√Ζ按照不同的沖刺條件時(shí)間要求轉(zhuǎn)化為速度參數(shù)以及加速度參數(shù)指令值，然后結(jié)合電機(jī)X、電機(jī)Y、電機(jī)Z和電機(jī)R上的光電編碼器反饋、電流傳感器的反饋和傳感器SI和S6對前方柱子的探測，經(jīng)內(nèi)部位置、速度和加速度控制程序，生成控制前后左右四輪的PWM波給L298N芯片，然后控制前后左右四輪以相同的加速度和速度直線前進(jìn)；當(dāng)?shù)竭_(dá)既定目標(biāo)時(shí)，微電腦鼠完成在坐標(biāo)(X+l，Υ+1)到坐標(biāo)(Χ+2，Υ+1)下的對角線沖刺，微電腦鼠完成一格樓梯迷宮的沖刺，把此時(shí)的迷宮坐標(biāo)更新為(Χ+2，Υ+2);依次類推，微電腦鼠完成Z格樓梯迷宮的沖刺，更新迷宮為(Χ+Ζ+1，Υ+Ζ+1)，微電腦鼠開始做轉(zhuǎn)出動(dòng)作，此時(shí)控制器會(huì)把曲線運(yùn)動(dòng)軌跡R_arcl_45和R_arc3_45按照不同的沖刺條件時(shí)間要求轉(zhuǎn)化為速度參數(shù)以及加速度參數(shù)指令值，然后結(jié)合電機(jī)X、電機(jī)Y、電機(jī)Z和電機(jī)R上的光電編碼器和電流傳感器的反饋經(jīng)內(nèi)部位置、速度和加速度控制程序，生成控制前后左右四輪的PWM波給L298N芯片，然后控制前后左右四輪以恒定的比值前進(jìn)；當(dāng)?shù)竭_(dá)既定目標(biāo)后，立即調(diào)整微電腦鼠左右輪的速度，控制器把曲線運(yùn)動(dòng)軌跡R_arc2_45和R_arc4_45按照不同的沖刺條件時(shí)間要求轉(zhuǎn)化為速度參數(shù)以及加速度參數(shù)指令值，然后結(jié)合電機(jī)X、電機(jī)Y、電機(jī)Z和電機(jī)R上的光電編碼器和電流傳感器的反饋經(jīng)內(nèi)部位置、速度和加速度控制程序，生成控制前后左右四輪的PWM波給L298N芯片，然后控制左右輪以恒定的比值前進(jìn)；在陀螺儀的控制下，保證到達(dá)當(dāng)?shù)竭_(dá)既定目標(biāo)B點(diǎn)時(shí)曲線R_arc2_45和R_arc4_45的斜率為O度，然后控制器把直線行走很短的距離Passing2按照不同的沖刺條件時(shí)間要求轉(zhuǎn)化為速度參數(shù)以及加速度參數(shù)指令值，然后結(jié)合電機(jī)X、電機(jī)Y、電機(jī)Z和電機(jī)R上的光電編碼器和電流傳感器的反饋經(jīng)內(nèi)部位置、速度和加速度控制程序，生成控制前后左右四輪的PWM波給L298N芯片，然后控制前后左右四輪以相同的加速度和速度前進(jìn)，當(dāng)?shù)竭_(dá)既定目標(biāo)后通過三段不同的軌跡完成在坐標(biāo)(X+Z+1，Y+Z+1)下整個(gè)右轉(zhuǎn)彎45度曲線軌跡的運(yùn)動(dòng)，微電腦鼠完成對角線沖刺后變?yōu)橹甭返能壽E改變，微電腦鼠進(jìn)入直線沖刺階段，此時(shí)前方傳感器S2、S3、S4和S5開始工作，進(jìn)入直線導(dǎo)航；并更新當(dāng)前坐標(biāo)為(Χ+Ζ+2，Υ+Ζ+1)在Χ+Ζ+2〈15和Y+Z+l〈15的前提下，判斷其坐標(biāo)是不是(7，7)、(7，8)、(8，7)、(8，8)其中的一個(gè)，如果不是將繼續(xù)更新其坐標(biāo)，如果是的話通知控制器已經(jīng)沖刺到目標(biāo)，然后置返航探索標(biāo)志為1，沖刺標(biāo)志為O，微電腦鼠準(zhǔn)備沖刺后的二次返程探索，去搜尋更優(yōu)的迷宮路徑；
8)在微電腦鼠沿著X軸、Y軸向前運(yùn)動(dòng)過程中如果有類似圖12的M型迷宮擋墻進(jìn)入前方的運(yùn)動(dòng)范圍，系統(tǒng)進(jìn)入沖刺子程序5，微電腦鼠將存儲(chǔ)此時(shí)坐標(biāo)(X，Y)，然后進(jìn)入圖13、圖14所示的曲線運(yùn)動(dòng)軌跡，在一次左沖刺轉(zhuǎn)彎時(shí)，ARM9處理器首先把行走直線很短的距離Leadingl按照不同的沖刺條件時(shí)間要求轉(zhuǎn)化為速度參數(shù)以及加速度參數(shù)指令值，然后結(jié)合電機(jī)X、電機(jī)Y、電機(jī)Z和電機(jī)R上的光電編碼器和電流傳感器的反饋經(jīng)內(nèi)部位置、速度和加速度控制程序，生成控制前后左右四輪的PWM波給L298N芯片，然后控制前后左右四輪以相同的加速度和速度直線前進(jìn)；當(dāng)?shù)竭_(dá)既定目標(biāo)時(shí)，把此時(shí)的迷宮坐標(biāo)更新為(Χ+1，Y)，傳感器參考值L90_FrontWallRef開始工作，防止外界干擾開始做誤差補(bǔ)償，誤差補(bǔ)償結(jié)束后控制器會(huì)把曲線運(yùn)動(dòng)軌跡L_Arcl和L_Arc3按照不同的沖刺條件時(shí)間要求轉(zhuǎn)化為速度參數(shù)以及加速度參數(shù)指令值，然后結(jié)合電機(jī)X、電機(jī)Y、電機(jī)Z和電機(jī)R的光電編碼器和電流傳感器的反饋經(jīng)內(nèi)部位置、速度和加速度控制程序，生成控制前后左右四輪的PWM波給L298N芯片，然后控制四輪的速度以恒定的比值轉(zhuǎn)彎；當(dāng)?shù)竭_(dá)既定目標(biāo)后，控制器會(huì)把曲線運(yùn)動(dòng)軌跡L_Arc2和L_Arc4按照不同的沖刺條件時(shí)間要求轉(zhuǎn)化為速度參數(shù)以及加速度參數(shù)指令值，然后結(jié)合電機(jī)X、電機(jī)Y、電機(jī)Z和電機(jī)R上的光電編碼器和電流傳感器的反饋經(jīng)內(nèi)部位置、速度和加速度控制程序，生成控制四輪的PWM波給L298N芯片，然后控制四輪的速度以恒定的比值轉(zhuǎn)彎；當(dāng)?shù)竭_(dá)既定目標(biāo)后，微電腦鼠在陀螺儀的控制下已經(jīng)左轉(zhuǎn)90度，控制器把直線行走很短的距離PaSSingl+Leading2，按照不同的沖刺條件時(shí)間要求轉(zhuǎn)化為速度參數(shù)以及加速度參數(shù)指令值，然后結(jié)合電機(jī)X、電機(jī)Y、電機(jī)Z和電機(jī)R上的光電編碼器和電流傳感器的反饋經(jīng)內(nèi)部位置、速度和加速度控制程序，生成控制四輪的PWM波給L298N芯片，然后控制四輪以相同的加速度和速度前進(jìn)，當(dāng)傳感器S5的值產(chǎn)生有高電平到低電平的躍變時(shí)，更新微電腦鼠坐標(biāo)為(X+1，Y+1)，微電腦鼠繼續(xù)以當(dāng)前的速度和加速前進(jìn)，當(dāng)?shù)竭_(dá)既定目標(biāo)時(shí)，傳感器參考值R90_FrOntWallRef開始工作，防止外界干擾開始做誤差補(bǔ)償，誤差補(bǔ)償結(jié)束后控制器會(huì)把曲線運(yùn)動(dòng)軌跡R_Arcl和R_Arc3按照不同的沖刺條件時(shí)間要求轉(zhuǎn)化為速度參數(shù)以及加速度參數(shù)指令值，然后結(jié)合電機(jī)X、電機(jī)Y、電機(jī)Z和電機(jī)R的光電編碼器和電流傳感器的反饋經(jīng)內(nèi)部位置、速度和加速度控制程序，生成控制前后左右四輪的PWM波給L298N芯片，然后控制四輪的速度以恒定的比值轉(zhuǎn)彎；當(dāng)?shù)竭_(dá)既定目標(biāo)后，控制器會(huì)把曲線運(yùn)動(dòng)軌跡R_Arc2和R_Arc4按照不同的沖刺條件時(shí)間要求轉(zhuǎn)化為速度參數(shù)以及加速度參數(shù)指令值，然后結(jié)合電機(jī)X、電機(jī)Y、電機(jī)Z和電機(jī)R上的光電編碼器和電流傳感器的反饋經(jīng)內(nèi)部位置、速度和加速度控制程序，生成控制四輪的PWM波給L298N芯片，然后控制四輪的速度以恒定的比值轉(zhuǎn)彎；當(dāng)?shù)竭_(dá)既定目標(biāo)后，微電腦鼠在陀螺儀的控制下已經(jīng)右轉(zhuǎn)90度，控制器把直線行走很短的距離PaSSing2+Leading3按照不同的沖刺條件時(shí)間要求轉(zhuǎn)化為速度參數(shù)以及加速度參數(shù)指令值，然后結(jié)合電機(jī)X、電機(jī)Y、電機(jī)Z和電機(jī)R上的光電編碼器和電流傳感器的反饋經(jīng)內(nèi)部位置、速度和加速度控制程序，生成控制四輪的PWM波給L298N芯片，然后控制四輪以相同的加速度和速度前進(jìn)，當(dāng)傳感器S5的值產(chǎn)生有高電平到低電平的躍變時(shí)，更新微電腦鼠坐標(biāo)為(X+2，Y+1)，微電腦鼠繼續(xù)以當(dāng)前的速度和加速前進(jìn)，當(dāng)?shù)竭_(dá)既定目標(biāo)時(shí)，傳感器參考值R90_FrOntWallRef開始工作，防止外界干擾開始做誤差補(bǔ)償，誤差補(bǔ)償結(jié)束后控制器會(huì)把曲線運(yùn)動(dòng)軌跡R_Arcl和R_Arc3按照不同的沖刺條件時(shí)間要求轉(zhuǎn)化為速度參數(shù)以及加速度參數(shù)指令值，然后結(jié)合電機(jī)X、電機(jī)Y、電機(jī)Z和電機(jī)R的光電編碼器和電流傳感器的反饋經(jīng)內(nèi)部位置、速度和加速度控制程序，生成控制前后左右四輪的PWM波給L298N芯片，然后控制四輪的速度以恒定的比值轉(zhuǎn)彎；當(dāng)?shù)竭_(dá)既定目標(biāo)后，控制器會(huì)把曲線運(yùn)動(dòng)軌跡R_Arc2和R_Arc4按照不同的沖刺條件時(shí)間要求轉(zhuǎn)化為速度參數(shù)以及加速度參數(shù)指令值，然后結(jié)合電機(jī)X、電機(jī)Y、電機(jī)Z和電機(jī)R上的光電編碼器和電流傳感器的反饋經(jīng)內(nèi)部位置、速度和加速度控制程序，生成控制四輪的PWM波給L298N芯片，然后控制四輪的速度以恒定的比值轉(zhuǎn)彎；當(dāng)?shù)竭_(dá)既定目標(biāo)后，微電腦鼠在陀螺儀的控制下已經(jīng)右轉(zhuǎn)90度，控制器把直線行走很短的距離PaSSing3+Leading4按照不同的沖刺條件時(shí)間要求轉(zhuǎn)化為速度參數(shù)以及加速度參數(shù)指令值，然后結(jié)合電機(jī)X、電機(jī)Y、電機(jī)Z和電機(jī)R上的光電編碼器和電流傳感器的反饋經(jīng)內(nèi)部位置、速度和加速度控制程序，生成控制四輪的PWM波給L298N芯片，然后控制四輪以相同的加速度和速度前進(jìn)，當(dāng)傳感器S2的值產(chǎn)生有高電平到低電平的躍變時(shí)，更新微電腦鼠坐標(biāo)為(X+2，Y)，微電腦鼠繼續(xù)以當(dāng)前的速度和加速前進(jìn)，當(dāng)?shù)竭_(dá)既定目標(biāo)時(shí)，傳感器參考值L90_FrOntWallRef開始工作，防止外界干擾開始做誤差補(bǔ)償，誤差補(bǔ)償結(jié)束后控制器會(huì)把曲線運(yùn)動(dòng)軌跡L_Arcl和L_Arc3按照不同的沖刺條件時(shí)間要求轉(zhuǎn)化為速度參數(shù)以及加速度參數(shù)指令值，然后結(jié)合電機(jī)X、電機(jī)Y、電機(jī)Z和電機(jī)R的光電編碼器和電流傳感器的反饋經(jīng)內(nèi)部位置、速度和加速度控制程序，生成控制前后左右四輪的PWM波給L298N芯片，然后控制四輪的速度以恒定的比值轉(zhuǎn)彎；當(dāng)?shù)竭_(dá)既定目標(biāo)后，控制器會(huì)把曲線運(yùn)動(dòng)軌跡L_Arc2和L_Arc4按照不同的沖刺條件時(shí)間要求轉(zhuǎn)化為速度參數(shù)以及加速度參數(shù)指令值，然后結(jié)合電機(jī)X、電機(jī)Y、電機(jī)Z和電機(jī)R上的光電編碼器和電流傳感器的反饋經(jīng)內(nèi)部位置、速度和加速度控制程序，生成控制四輪的PWM波給L298N芯片，然后控制四輪的速度以恒定的比值轉(zhuǎn)彎；當(dāng)?shù)竭_(dá)既定目標(biāo)后，陀螺儀控制微電腦鼠已經(jīng)左轉(zhuǎn)90度，控制器把直線行走很短的距離PaSSing4+Leading5按照不同的沖刺條件時(shí)間要求轉(zhuǎn)化為速度參數(shù)以及加速度參數(shù)指令值，然后結(jié)合電機(jī)X、電機(jī)Y、電機(jī)Z和電機(jī)R上的光電編碼器和電流傳感器的反饋經(jīng)內(nèi)部位置、速度和加速度控制程序，生成控制四輪的PWM波給L298N芯片，然后控制四輪以相同的加速度和速度前進(jìn)，當(dāng)傳感器S5的值產(chǎn)生有高電平到低電平的躍變時(shí)，微電腦鼠完成一個(gè)M型的沖刺，更新微電腦鼠坐標(biāo)為(X+3，Y)，依次類推，微電腦鼠經(jīng)過Z個(gè)M型后，更新微電腦鼠坐標(biāo)為(X+2*Z+1，Y)，判斷其坐標(biāo)是不是(7，7)、(7，8)、(8，7)、(8，8)其中的一個(gè)，如果不是將繼續(xù)更新其坐標(biāo)，如果是的話通知控制器已經(jīng)沖刺到目標(biāo)，然后置返航探索標(biāo)志為1，沖刺標(biāo)志為0，微電腦鼠準(zhǔn)備沖刺后的二次返程探索，去搜尋更優(yōu)的迷宮路徑；
9)當(dāng)微電腦鼠沖刺到達(dá)(7，7)、(7，8)、(8，7)、(8，8)后會(huì)準(zhǔn)備沖刺后的返程探索以便搜尋更優(yōu)的路徑，控制器會(huì)調(diào)出其已經(jīng)存儲(chǔ)的迷宮信息，然后計(jì)算出可能存在的其它最佳路徑，然后返程開始進(jìn)入其中認(rèn)為最優(yōu)的一條，
10)為了能夠?qū)崿F(xiàn)微電腦鼠快速?zèng)_刺準(zhǔn)確的坐標(biāo)計(jì)算功能，微電腦鼠左右的傳感器S2、S3和S4、S5會(huì)時(shí)刻對周圍的迷宮擋墻和柱子進(jìn)行探測，如果S2、S3或者S4、S5發(fā)現(xiàn)傳感器信號發(fā)生了躍變，則說明微電腦鼠進(jìn)入了迷宮擋墻和柱子的交接點(diǎn)，此時(shí)側(cè)面?zhèn)鞲衅鱏2或者是S5會(huì)精確探測這一時(shí)刻，當(dāng)再次出現(xiàn)躍變時(shí)，說明老鼠已經(jīng)開始離開當(dāng)前的迷宮格子，ARM9處理器會(huì)根據(jù)微電腦鼠當(dāng)前運(yùn)行的距離進(jìn)行計(jì)算并根據(jù)對傳感器反饋信息進(jìn)行補(bǔ)償，本發(fā)明在高速直流電機(jī)X軸、Y軸、電機(jī)Z和電機(jī)R上加入了 512線的光電編碼器，由于精度較高，使得微電腦鼠的坐標(biāo)計(jì)算不會(huì)出現(xiàn)錯(cuò)誤，保證了微電腦鼠快速?zèng)_刺迷宮信息的準(zhǔn)請性；
11)在微電腦鼠進(jìn)入迷宮返程探索時(shí)，其導(dǎo)航的傳感器S1、S2、S3、S4、S5、S6將工作，并把反射回來的光電信號送給ARM9處理器，經(jīng)ARM9處理器運(yùn)算后確定現(xiàn)在迷宮所處位置，然后由ARM9處理器根據(jù)當(dāng)前迷宮生成PWM波和送控制信號給L298N芯片:如果進(jìn)入已經(jīng)搜索的區(qū)域?qū)⒓哟驪WM波的占空比，使微電腦鼠進(jìn)行快速前進(jìn)，減少迷宮搜索的時(shí)間；如果是未知返回區(qū)域則采用正常速度搜索，并時(shí)刻更新其坐標(biāo)(X，Y)，并判斷其坐標(biāo)是不是(0，
0)，如果是的話置返航探索標(biāo)志為0，微電腦鼠進(jìn)入沖刺階段，并置沖刺標(biāo)志為I ;
12)在微電腦鼠運(yùn)動(dòng)過程中，如果系統(tǒng)出現(xiàn)了干擾，ARM9處理器會(huì)根據(jù)當(dāng)前狀態(tài)對電流加以補(bǔ)償，快速調(diào)整電流環(huán)的PID參數(shù)，使得系統(tǒng)快速穩(wěn)定下來，防止高速?zèng)_刺時(shí)干擾對系統(tǒng)的影響；
13)在微電腦鼠快速?zèng)_刺過程中，電池提供的瞬時(shí)功率是一定的，在沖刺速度一定的條件下，加速度越大時(shí)，需要的力矩就越大，此時(shí)需要電池提供的電流就越大，為了保護(hù)電池，本發(fā)明加入了硬件保護(hù)，否則將嚴(yán)重傷害電池；
14)為了能夠減少光源對微電腦鼠沖刺的干擾，本發(fā)明加入了光電傳感器S8，此傳感器會(huì)在微電腦鼠沖刺階段對周圍的異常光源進(jìn)行讀取，并自動(dòng)送給控制器做實(shí)時(shí)補(bǔ)償，消除了外界光源對沖刺的干擾；
15)當(dāng)微電腦完成整個(gè)沖刺過程到達(dá)(7，7)、(7，8)、(8，7)、(8，8)，微電腦鼠會(huì)置探索標(biāo)志為1，微電腦鼠返程探索回到起始點(diǎn)(0，0)，ARM9處理器將控制兩片L298N芯片的電平輸出使得微電腦起始點(diǎn)中心點(diǎn)停車，然后重新調(diào)整L298N芯片的0UT1、0UT2、0UT3和0UT4的電平，使得兩側(cè)的電機(jī):電機(jī)X、電機(jī)Z和電機(jī)Y、電機(jī)R以相反的方向運(yùn)動(dòng)，并在陀螺儀的控制下，原地旋轉(zhuǎn)180度，然后停車I秒，二次調(diào)取迷宮信息，然后根據(jù)算法算出優(yōu)化迷宮信息后的最優(yōu)沖刺路徑，然后置沖刺標(biāo)志為1，系統(tǒng)進(jìn)入二次快速?zèng)_刺階段，然后按照沖刺——探索沖刺，完成多次的沖刺，以達(dá)到快速?zèng)_刺的目的。
[0037]本發(fā)明基于ARM9四輪快速微電腦鼠對角線沖刺系統(tǒng)具有的有益效果是:
1:在運(yùn)動(dòng)過程中，充分考慮了電池在這個(gè)系統(tǒng)中的作用，基于ARM9處理器控制器時(shí)刻都在對微電腦鼠的運(yùn)行狀態(tài)進(jìn)行監(jiān)測和運(yùn)算，避免了大電流的產(chǎn)生，并且時(shí)刻顯示鋰離子電池的S0C，有利于了解電池的能量狀態(tài)，由于本發(fā)明采用永磁直流電機(jī)，電機(jī)的加速度和電機(jī)的電流呈一定比例關(guān)系，所以當(dāng)電池SOC較低時(shí)，為了保證沖刺時(shí)能量的要求，可以在沖刺前提前換掉電池，從而減少了電池因?yàn)榉烹婋娏鬟^高對高速?zèng)_刺的誤干擾；
2:為了充分保證微電腦鼠系統(tǒng)快速?zèng)_刺時(shí)的穩(wěn)定性和行駛能力，本發(fā)明采用四輪驅(qū)動(dòng)結(jié)構(gòu)，前置驅(qū)動(dòng)和后置驅(qū)動(dòng)的四個(gè)電機(jī)功率一致，由于采用四輪驅(qū)動(dòng)技術(shù)，微電腦鼠前后輪都有動(dòng)力，可按迷宮地面和周圍環(huán)境狀態(tài)不同而將需求扭矩按不同比例分布在前后所有的輪子上，以提高微電腦鼠的快速行駛能力；
3:根據(jù)需要實(shí)現(xiàn)分時(shí)四驅(qū)，在正常快速?zèng)_刺時(shí)，微電腦鼠一般會(huì)采用釋放前輪，采用后輪驅(qū)動(dòng)的方式；而一旦遇到路面灰塵較多或驅(qū)動(dòng)輪打滑的情況，ARM9處理器會(huì)自動(dòng)檢測并立即將微電腦鼠需求扭矩分配一部分給前方兩個(gè)前輪，自然切換到四輪驅(qū)動(dòng)狀態(tài)，增強(qiáng)了微電腦鼠快速?zèng)_刺時(shí)的附著力和操控性；
4:由于采用四輪驅(qū)動(dòng)方式，當(dāng)微電腦鼠需要加速?zèng)_刺時(shí)，把動(dòng)力平均分配到四個(gè)電機(jī)，一旦一個(gè)動(dòng)力輪離開地面，ARM9處理器可以重新分配扭矩，把更多的扭矩分配在不打滑的驅(qū)動(dòng)輪上，使系統(tǒng)迅速脫離打滑狀態(tài)，重新回到四軸動(dòng)力平衡狀態(tài)，使得微電腦鼠保持較高的沖刺能力；
5:微電腦鼠沖刺轉(zhuǎn)向時(shí)，為了保證旋轉(zhuǎn)的穩(wěn)定性，采用四輪同控來實(shí)現(xiàn)轉(zhuǎn)彎:需要停車時(shí)，ARM9處理器把動(dòng)力平均分配到四個(gè)電機(jī)，四個(gè)電機(jī)采用相同的加速度進(jìn)行同步減速，使微電腦鼠準(zhǔn)確停車；然后在陀螺儀的控制下精確旋轉(zhuǎn)需要的角度，然后進(jìn)行加速，在加速行駛時(shí)，ARM9處理器把動(dòng)力平均分配到四個(gè)電機(jī)，四個(gè)電機(jī)采用相同的加速度進(jìn)行同步加速，到達(dá)設(shè)定速度時(shí)，釋放前輪采用后輪驅(qū)動(dòng)；由ARM9處理器結(jié)合轉(zhuǎn)彎時(shí)間的要求根據(jù)軌跡的不同生成四路PWM控制直流電機(jī)X、電機(jī)Y、電機(jī)Z和電機(jī)R，完成四軸直流伺服系統(tǒng)的冋步轉(zhuǎn)彎控制；
6:四輪微電腦鼠系統(tǒng)在正常行駛時(shí)如果設(shè)計(jì)不當(dāng)造成重心前偏，將導(dǎo)致后側(cè)驅(qū)動(dòng)輪上承受的正壓力減小，ARM9處理器會(huì)在其沖刺時(shí)自動(dòng)調(diào)整后側(cè)的動(dòng)力分配，使系統(tǒng)處于一種新的平衡狀態(tài)，防止微電腦鼠快速次沖刺時(shí)打滑；
7:四輪微電腦鼠系統(tǒng)在正常行駛時(shí)如果設(shè)計(jì)不當(dāng)造成重心側(cè)偏，將導(dǎo)致一側(cè)驅(qū)動(dòng)輪上承受的正壓力減小，ARM9處理器會(huì)在其沖刺時(shí)自動(dòng)調(diào)整這一側(cè)的動(dòng)力分配，使系統(tǒng)處于一種新的平衡狀態(tài)，防止微電腦鼠快速次沖刺時(shí)打滑；
8:由ARM9處理器處理微電腦鼠高速?zèng)_刺時(shí)的四只直流電機(jī)的伺服控制，使得控制比較簡單，大大提高了運(yùn)算速度，解決了單片機(jī)軟件運(yùn)行較慢的瓶頸，縮短了開發(fā)周期短，并且程序可移植能力強(qiáng)；
9:本發(fā)明基本實(shí)現(xiàn)全貼片元器件材料，實(shí)現(xiàn)了單板控制，不僅降低了微電腦鼠的體積，而且也降低了其重心，有利于其快速?zèng)_刺；
10:本發(fā)明加入了兩片陀螺儀ADXRS300ABG，ADXRS300陀螺儀采用了 ADI公司的集成微電子機(jī)械系統(tǒng)(IMMS)專利工藝，帶有集成信號調(diào)理的表面微機(jī)械角速度傳感器比任何同功能的陀螺儀的尺寸小，功耗低，抗沖擊和震動(dòng)性好，一個(gè)陀螺儀的角速度可以按時(shí)間累計(jì)以便確定角坐標(biāo)，這對于微電腦鼠連續(xù)旋轉(zhuǎn)一定角度計(jì)算具有導(dǎo)航作用，可以實(shí)現(xiàn)兩輪微電腦鼠的速度大小和方向的獨(dú)立控制，有利于提高微電腦鼠沖刺時(shí)的穩(wěn)定性和動(dòng)態(tài)性能；另外一個(gè)陀螺儀來測量車輪轉(zhuǎn)速，如果陀螺儀檢測到車輪速度失控，控制器會(huì)使其回到控制狀態(tài)；
11:為了提高運(yùn)算速度和精度，本微電腦鼠采用國際上使用最多的紅外發(fā)射器OPE5594A和紅外接收器TSL262，并且對于前方的迷宮擋墻舍棄了國內(nèi)單一傳感器探測模式而采用雙傳感器探測，使得運(yùn)算精度大大提高，有利于提高前方迷宮擋墻對高速?zèng)_刺時(shí)的導(dǎo)航作用；
12:由于本控制器采用ARM9處理器處理迷宮讀取和沖刺算法，有效地防止了程序的“跑飛”，抗干擾能力大大增強(qiáng)；
13:由于本控制器采用來L298N芯片來驅(qū)動(dòng)四軸直流電機(jī)，極大地減少了驅(qū)動(dòng)電路所占用的空間，并提高了系統(tǒng)的效率和穩(wěn)定性；
14:由ARM9處理器輸出沖刺時(shí)PWM調(diào)制信號和方向信號，然后通過L298N芯片的使能端直接驅(qū)動(dòng)直流電機(jī)，不僅減輕了 ARM9處理器的負(fù)擔(dān)，而且簡化了接口電路，使得系統(tǒng)的調(diào)試簡單；
15:在微電腦鼠快速?zèng)_刺過程中，控制器會(huì)對直流電機(jī)的轉(zhuǎn)矩進(jìn)行在線辨識并利用電機(jī)力矩與電流的關(guān)系進(jìn)行補(bǔ)償，減少了電機(jī)轉(zhuǎn)矩抖動(dòng)對微電腦鼠快速?zèng)_刺的影；
16:由于微電腦鼠的四輪速度和方向獨(dú)立控制，使得微電腦鼠更容易實(shí)現(xiàn)曲線軌跡的轉(zhuǎn)動(dòng)；
17:由于具有存儲(chǔ)功能，這使得微電腦鼠可以輕易調(diào)取已經(jīng)探索好的迷宮信息，可以優(yōu)化二次沖刺的路徑，降低沖刺時(shí)間；
18:根據(jù)對接觸扣分不同的沖刺要求，本文設(shè)計(jì)多種沖刺方法，完全滿足現(xiàn)實(shí)需要；
19:由于采用自動(dòng)沖刺方法，所以從根本上杜絕了接觸扣分；但是一旦遇到?jīng)_刺失敗時(shí)，由于具有存儲(chǔ)迷宮信息的功能，所以可以輕易調(diào)取已經(jīng)優(yōu)化的沖刺迷宮信息，減少了探索的環(huán)節(jié)；
20:為了減少?zèng)_刺時(shí)間，對于樓梯型沖刺迷宮采用45度對角線轉(zhuǎn)法，比連續(xù)轉(zhuǎn)法還要節(jié)省時(shí)間，并且在在沖刺階段一直有前方的傳感器SI和S6對柱子信息進(jìn)行采集并時(shí)刻進(jìn)行補(bǔ)償，保證了沖刺的準(zhǔn)確性和穩(wěn)定性；
21:為了減少?zèng)_刺時(shí)間，對于M型迷宮采用U轉(zhuǎn)法，由于在沖刺階段一直有傳感器進(jìn)行補(bǔ)償，增加了沖刺的穩(wěn)定性；
22:對于多次連轉(zhuǎn)由于采用綜合考慮位置、速度和加速度參數(shù)，避免了單獨(dú)轉(zhuǎn)法的累計(jì)誤差造成沖刺失敗現(xiàn)象的發(fā)生。
[0038]以上所述僅為本發(fā)明的實(shí)施例，并非因此限制本發(fā)明的專利范圍，凡是利用本發(fā)明說明書內(nèi)容所作的等效結(jié)構(gòu)或等效流程變換，或直接或間接運(yùn)用在其它相關(guān)的【技術(shù)領(lǐng)域】，均同理包括在本發(fā)明的專利保護(hù)范圍內(nèi)。
【權(quán)利要求】
1.一種基于ARM9四輪快速微電腦鼠對角線沖刺系統(tǒng)，其特征在于，包括處理器單元、電機(jī)X、電機(jī)Y、電機(jī)Z、電機(jī)R以及微電腦鼠機(jī)械裝置，所述的處理器單元分別與電機(jī)X、電機(jī)Y、電機(jī)Z以及電機(jī)R進(jìn)行電性連接，所述的電機(jī)X、電機(jī)Y、電機(jī)Z以及電機(jī)R與微電腦鼠機(jī)械裝置進(jìn)行連接，其中，所述的處理器單元包括ARM9處理器和L298N芯片，所述的ARM9處理器和L298N芯片進(jìn)行電性連接。
2.根據(jù)權(quán)利要求1所述的基于ARM9四輪快速微電腦鼠對角線沖刺系統(tǒng)，其特征在于，所述的處理器單元分別發(fā)出第一控制信號、第二控制信號、第三控制信號以及第四控制信號，由第一控制信號、第二控制信號、第三控制信號以及第四控制信號分別對應(yīng)控制電機(jī)X、電機(jī)Y、電機(jī)Z以及電機(jī)R。
3.根據(jù)權(quán)利要求1所述的基于ARM9四輪快速微電腦鼠對角線沖刺系統(tǒng)，其特征在于，所述的處理器單元還包括設(shè)于ARM9處理器和L298N芯片的上位機(jī)系統(tǒng)和運(yùn)動(dòng)控制系統(tǒng)，所述的上位機(jī)系統(tǒng)包括迷宮讀取模塊、坐標(biāo)定位模塊以及在線輸出模塊，所述的運(yùn)動(dòng)控制系統(tǒng)包括伺服控制模塊、數(shù)據(jù)存儲(chǔ)模塊以及I/O控制模塊，其中，所述的迷宮讀取模塊、坐標(biāo)定位模塊、在線輸出模塊、數(shù)據(jù)存儲(chǔ)模塊以及I/O控制模塊分別與所述的L298N芯片進(jìn)行電性連接。
4.根據(jù)權(quán)利要求3所述的基于ARM9四輪快速微電腦鼠對角線沖刺系統(tǒng)，其特征在于，所述的伺服控制模塊還包括電流模塊、速度模塊以及坐標(biāo)模塊，所述的控制伺服控制模塊與所述的ARM9處理器進(jìn)行電性連接。
5.根據(jù)權(quán)利要求1所述的基于ARM9四輪快速微電腦鼠對角線沖刺系統(tǒng)，其特征在于，所述的微電腦鼠連轉(zhuǎn)沖刺系統(tǒng)還包括電池，所述的電池與所述的處理器單元進(jìn)行電性連接。
6.根據(jù)權(quán)利要求5所述的基于ARM9四輪快速微電腦鼠對角線沖刺系統(tǒng)，其特征在于，所述的電池為鋰離子電池。
7.根據(jù)權(quán)利要求1所述的基于ARM9四輪快速微電腦鼠對角線沖刺系統(tǒng)，其特征在于，所述的電機(jī)X、電機(jī)Y、電機(jī)Z和電機(jī)R均為高速永磁直流電機(jī)。
8.根據(jù)權(quán)利要求1所述的基于ARM9四輪快速微電腦鼠對角線沖刺系統(tǒng)，其特征在于，所述的電機(jī)X、電機(jī)Y、電機(jī)Z和電機(jī)R的轉(zhuǎn)軸上均設(shè)有光電編碼器。
9.根據(jù)權(quán)利要求1所述的基于ARM9四輪快速微電腦鼠對角線沖刺系統(tǒng)，其特征在于，所述的微電腦鼠機(jī)械裝置上設(shè)有光電傳感器、電壓傳感器以及六個(gè)屏蔽傳感器，所述光電傳感器、電壓傳感器以及屏蔽傳感器分別與所述的處理器單元進(jìn)行電性連接。
10.根據(jù)權(quán)利要求1所述的基于ARM9四輪快速微電腦鼠對角線沖刺系統(tǒng)，其特征在于，所述的微電腦鼠機(jī)械裝置上設(shè)有兩片陀螺儀，所述的陀螺儀與所述的處理器單元進(jìn)行電性連接。
【文檔編號】G05D1/02GK103529834SQ201310439573
【公開日】2014年1月22日 申請日期:2013年9月24日 優(yōu)先權(quán)日:2013年9月24日
【發(fā)明者】張好明, 王應(yīng)海 申請人:蘇州工業(yè)園區(qū)職業(yè)技術(shù)學(xué)院