當前位置:編程學習大全網 - 編程語言 - 循跡小車可以走規劃路線嗎

循跡小車可以走規劃路線嗎

可以的,但是需要妳會寫程序。

1. 小車控制及驅動單元的選擇 此部分是整個小車的大腦,是整個小車運行的核心部件,起著控制小車所有運行狀態的作用。通常選用單片機作為小車的核心控制單元,在這裏用臺灣淩陽公司的SPCE061A單片機來做小車的控制單元。SPCE061是壹款擁有2K RAM、32KFlash、32 個I/O 口,並集成了AD/DA功能強大的16位微處理器,它還擁有豐富的語音處理功能,為小車的功能擴展提供了相當大的空間。只要按照該單片機的要求對其編制程序就可以實現很多不同的功能。小車驅動電機壹般利用現成的玩具小車上的配套直流電機。考慮到小車必須能夠前進、倒退、停止,並能靈活轉向,在左右兩輪各裝壹個電機分別進行驅動。當左輪電機轉速高於右輪電機轉速時小車向右轉,反之則向左轉。為了能控制車輪的轉速,可以采取PWM調速法,即由單片機的IOB8、IOB9輸出壹系列頻率固定的方波,再通過功率放大來驅動電機,在單片機中編程改變輸出方波的占空比就可以改變加到電機上的平均電壓,從而可以改變電機的轉速。左右輪兩個電機轉速的配合就可以實現小車的前進、倒退、轉彎等功能。 2. 小車循跡的原理 這裏的循跡是指小車在白色地板上循黑線行走,通常采取的方法是紅外探測法。紅外探測法,即利用紅外線在不同顏色的物體表面具有不同的反射性質的特點,在小車行駛過程中不斷地向地面發射紅外光,當紅外光遇到白色紙質地板時發生漫反射,反射光被裝在小車上的接收管接收;如果遇到黑線則紅外光被吸收,小車上的接收管接收不到紅外光。單片機就是否收到反射回來的紅外光為依據來確定黑線的位置和小車的行走路線。紅外探測器探測距離有限,壹般最大不應超過15cm。對於發射和接收紅外線的紅外探頭,可以自己制作或直接采用集成式紅外探頭。 (1)自制紅外探頭電路如圖1所示,紅外光的發送接收選用型號為ST168的對管。當小車在白色地面行駛時,裝在車下的紅外發射管發射紅外線信號,經白色反射後,被接收管接收,壹旦接收管接收到信號,那麽圖中光敏三極管將導通,比較器輸出為低電平;當小車行駛到黑色引導線時,紅外線信號被黑色吸收後,光敏三極管截止,比較器輸出高電平,從而實現了通過紅外線檢測信號的功能。將檢測到的信號送到單片機I/O口,當I/O口檢測到的信號為高電平時,表明紅外光被地上的黑色引導線吸收了,表明小車處在黑色的引導線上;同理,當I/O口檢測到的信號為低電平時,表明小車行駛在白色地面上。此種方法簡單,價格便宜,靈敏度可調,但是容易受到周圍環境的影響,特別是在圖1較強的日光燈下,對檢測到的信號有壹定的影響。 (2)集成式紅外探頭可以采用型號為E3F-DS10C4集成斷續式光電開關探測器,它具有簡單、可靠的工作性能,只要調節探頭上的壹個旋鈕就可以控制探頭的靈敏度。該探頭輸出端只有三根線(電源線、地線、信號線),只要將信號線接在單片機的I/O口,然後不停地對該I/O口進行掃描檢測,當其為高電平時則檢測到白紙,當為低電平時則檢測到黑線。此種探頭還能有效地防止普通光源(如日光燈等)的幹擾。其缺點則是體積比較大,占用了小車有限的空間。 3.紅外探頭的安裝 在小車具體的循跡行走過程中,為了能精確測定黑線位置並確定小車行走的方向,需要同時在底盤裝設4個紅外探測頭,進行兩級方向糾正控制,提高其循跡的可靠性。這4個紅外探頭的具體位置如圖2所示。圖中循跡傳感器***安裝4個,全部在壹條直線上。其中InfraredMR與InfraredML 為第壹級方向控制傳感器,InfraredSR 與InfraredSL 為第二級方向控制傳感器。小車行走時,始終保持黑線(如圖2 中所示的行走軌跡黑線)在InfraredMR和InfraredML這兩個第壹級傳感器之間,當小車偏離黑線時,第壹級探測器壹旦探測到有黑線,單片機就會按照預先編定的程序發送指令給小車的控 制系統,控制系統再對小車路徑予以糾正。若小車回到了軌道上,即4個探測器都只檢測到白紙,則小車會繼續行走;若小車由於慣性過大依舊偏離軌道,越出了第壹級兩個探測器的探測範圍,這時第二級動作,再次對小車的運動進行糾正,使之回到正確軌道上去。可以看出,第二級方向探測器實際是第壹級的後備保護,從而提高了小車循跡的可靠性。 4.軟件控制 其程序控制框圖如圖3。小車進入循跡模式後,即開始不停地掃描與探測器連接的單片機I/O口,壹旦檢測到某個I/O口有信號,即進入判斷處理程序(switch),先確定4個探測器中的哪壹個探測到了黑線,如果InfraredML(左面第壹級傳感器)或者InfraredSL(左面第二級傳感器)探測到黑線,即小車左半部分壓到黑線,車身向右偏出,此時應使小車向左轉;如果是InfraredMR(右面第壹級傳感 器)或InfraredSR(右面第二級傳感器)探測到了黑線,即車身右半部壓住黑線,小車向左偏出了軌跡,則應使小車向右轉。在經過了方向調整後,小車再繼續向前行走,並繼續探測黑線重復上述動作。 由於第二級方向控制為第壹級的後備,則兩個等級間的轉向力度必須相互配合。 電動循跡小車設計1. 小車控制及驅動單元的選擇 此部分是整個小車的大腦,是整個小車運行的核心部件,起著控制小車所有運行狀態的作用。通常選用單片機作為小車的核心控制單元,在這裏用臺灣淩陽公司的SPCE061A單片機來做小車的控制單元。SPCE061是壹款擁有2K RAM、32KFlash、32 個I/O 口,並集成了AD/DA功能強大的16位微處理器,它還擁有豐富的語音處理功能,為小車的功能擴展提供了相當大的空間。只要按照該單片機的要求對其編制程序就可以實現很多不同的功能。小車驅動電機壹般利用現成的玩具小車上的配套直流電機。考慮到小車必須能夠前進、倒退、停止,並能靈活轉向,在左右兩輪各裝壹個電機分別進行驅動。當左輪電機轉速高於右輪電機轉速時小車向右轉,反之則向左轉。為了能控制車輪的轉速,可以采取PWM調速法,即由單片機的IOB8、IOB9輸出壹系列頻率固定的方波,再通過功率放大來驅動電機,在單片機中編程改變輸出方波的占空比就可以改變加到電機上的平均電壓,從而可以改變電機的轉速。左右輪兩個電機轉速的配合就可以實現小車的前進、倒退、轉彎等功能。 2. 小車循跡的原理 這裏的循跡是指小車在白色地板上循黑線行走,通常采取的方法是紅外探測法。紅外探測法,即利用紅外線在不同顏色的物體表面具有不同的反射性質的特點,在小車行駛過程中不斷地向地面發射紅外光,當紅外光遇到白色紙質地板時發生漫反射,反射光被裝在小車上的接收管接收;如果遇到黑線則紅外光被吸收,小車上的接收管接收不到紅外光。單片機就是否收到反射回來的紅外光為依據來確定黑線的位置和小車的行走路線。紅外探測器探測距離有限,壹般最大不應超過15cm。對於發射和接收紅外線的紅外探頭,可以自己制作或直接采用集成式紅外探頭。 (1)自制紅外探頭電路如圖1所示,紅外光的發送接收選用型號為ST168的對管。當小車在白色地面行駛時,裝在車下的紅外發射管發射紅外線信號,經白色反射後,被接收管接收,壹旦接收管接收到信號,那麽圖中光敏三極管將導通,比較器輸出為低電平;當小車行駛到黑色引導線時,紅外線信號被黑色吸收後,光敏三極管截止,比較器輸出高電平,從而實現了通過紅外線檢測信號的功能。將檢測到的信號送到單片機I/O口,當I/O口檢測到的信號為高電平時,表明紅外光被地上的黑色引導線吸收了,表明小車處在黑色的引導線上;同理,當I/O口檢測到的信號為低電平時,表明小車行駛在白色地面上。此種方法簡單,價格便宜,靈敏度可調,但是容易受到周圍環境的影響,特別是在圖1較強的日光燈下,對檢測到的信號有壹定的影響。 (2)集成式紅外探頭可以采用型號為E3F-DS10C4集成斷續式光電開關探測器,它具有簡單、可靠的工作性能,只要調節探頭上的壹個旋鈕就可以控制探頭的靈敏度。該探頭輸出端只有三根線(電源線、地線、信號線),只要將信號線接在單片機的I/O口,然後不停地對該I/O口進行掃描檢測,當其為高電平時則檢測到白紙,當為低電平時則檢測到黑線。此種探頭還能有效地防止普通光源(如日光燈等)的幹擾。其缺點則是體積比較大,占用了小車有限的空間。 3.紅外探頭的安裝 在小車具體的循跡行走過程中,為了能精確測定黑線位置並確定小車行走的方向,需要同時在底盤裝設4個紅外探測頭,進行兩級方向糾正控制,提高其循跡的可靠性。這4個紅外探頭的具體位置如圖2所示。圖中循跡傳感器***安裝4個,全部在壹條直線上。其中InfraredMR與InfraredML 為第壹級方向控制傳感器,InfraredSR 與InfraredSL 為第二級方向控制傳感器。小車行走時,始終保持黑線(如圖2 中所示的行走軌跡黑線)在InfraredMR和InfraredML這兩個第壹級傳感器之間,當小車偏離黑線時,第壹級探測器壹旦探測到有黑線,單片機就會按照預先編定的程序發送指令給小車的控 制系統,控制系統再對小車路徑予以糾正。若小車回到了軌道上,即4個探測器都只檢測到白紙,則小車會繼續行走;若小車由於慣性過大依舊偏離軌道,越出了第壹級兩個探測器的探測範圍,這時第二級動作,再次對小車的運動進行糾正,使之回到正確軌道上去。可以看出,第二級方向探測器實際是第壹級的後備保護,從而提高了小車循跡的可靠性。 4.軟件控制 其程序控制框圖如圖3。小車進入循跡模式後,即開始不停地掃描與探測器連接的單片機I/O口,壹旦檢測到某個I/O口有信號,即進入判斷處理程序(switch),先確定4個探測器中的哪壹個探測到了黑線,如果InfraredML(左面第壹級傳感器)或者InfraredSL(左面第二級傳感器)探測到黑線,即小車左半部分壓到黑線,車身向右偏出,此時應使小車向左轉;如果是InfraredMR(右面第壹級傳感 器)或InfraredSR(右面第二級傳感器)探測到了黑線,即車身右半部壓住黑線,小車向左偏出了軌跡,則應使小車向右轉。在經過了方向調整後,小車再繼續向前行走,並繼續探測黑線重復上述動作。 由於第二級方向控制為第壹級的後備,則兩個等級間的轉向力度必須相互配合。第二級通常是在超出第壹級的控制範圍的情況下發生作用,它也是最後壹層保護,所以它必須要保證小車回到正確軌跡上來,則通常使第二級轉向力度大於第壹級,即level2>level1(level1、level2為小車轉向力度,其大小通過改變單片機輸出的占空比的大小來改變),具體數值在實地實驗中得到。根據上面所講述的方法,我們可以較容易地做出按照壹定軌跡行走的智能電動小車。但是按照該方法行走的小車如果是走直線,有可能會是蛇形前進。為了使小車能夠按軌跡行走的更流暢,可以在軟件編程時運用壹些簡單的算法。例如,在對小車進行糾偏時,適當提前停止糾偏,而不要等到小車完全不偏時再停止,以防止小車的過沖。 第二級通常是在超出第壹級的控制範圍的情況下發生作用,它也是最後壹層保護,所以它必須要保證小車回到正確軌跡上來,則通常使第二級轉向力度大於第壹級,即level2>level1(level1、level2為小車轉向力度,其大小通過改變單片機輸出的占空比的大小來改變),具體數值在實地實驗中得到。 根據上面所講述的方法,我們可以較容易地做出按照壹定軌跡行走的智能電動小車。但是按照該方法行走的小車如果是走直線,有可能會是蛇形前進。為了使小車能夠按軌跡行走的更流暢,可以在軟件編程時運用壹些簡單的算法。例如,在對小車進行糾偏時,適當提前停止糾偏,而不要等到小車完全不偏時再停止,以防止小車的過沖

  • 上一篇:微機原理實驗用的匯編軟件問題
  • 下一篇:如何選擇燈帶
  • copyright 2024編程學習大全網