基于視覺(jué)的智能尋跡車(chē)設計與實(shí)現
V3值線(xiàn)性正比于前輪舵機中可變電阻角度α1,因此,不同的傳感器探測位置,可以計算得出不同的理想前輪轉向角度,不同的理想轉向A/D電壓,通過(guò)單片機測量V3,即可換算前輪舵機中可變電阻轉向角度a1,并與理想轉向A/D電壓比較,當V3達到理想轉向A/D電壓,單片機控制給舵機低電平,舵機停轉,保持轉向,從而實(shí)現精確分級轉向。
3 軟件設計
3.1 主程序設計
采用C語(yǔ)言在ICC―AVR開(kāi)發(fā)環(huán)境下進(jìn)行編程調試。主程序流程圖如圖5所示。
3.2 分級模塊程序設計
ATMEGAl6能對來(lái)自端口A(yíng)的8路單端輸入電壓進(jìn)行采樣。當片中ADC多功能寄存器ADMUX的REFSl和 REFS0設置為1時(shí),VAREF=2.56 V,為片內穩定基準電壓源,即圖3中電壓V。智能尋跡車(chē)轉向極限為±30°,表1為5個(gè)光電傳感器分級精確轉向相應計算數據。
4 結 語(yǔ)
基于視覺(jué)的智能尋跡車(chē)模設計方案能夠在線(xiàn)型復雜,轉彎半徑不確定性大的情況下,利用視覺(jué)自主尋跡前進(jìn),分級精確轉向。對于環(huán)境光線(xiàn)的影響,可考慮增加濾波電路、優(yōu)化控制算法增加其抗干擾能力。實(shí)驗證明,該方案有良好的尋跡效果。
評論