基于MSP430單片機(jī)的智能小車尋跡模塊研究
繪制完成的反射式光電傳感器電路圖如圖2所示。該電路的工作原理為:當(dāng)光耦TCRT5000有光線反射回來,即遇到白色等反光能力強(qiáng)的跑道,放大器LM324AD的輸出端輸出為高電平,反之,輸出為低電平。單片機(jī)通過控制LM324AD的輸出端電壓即可做出相應(yīng)的控制操作。四個(gè)相同的此模塊分別與單片機(jī)的P41,P42,P43,P44引腳相連。單片機(jī)模塊如圖3所示。
3 循跡模塊的軟件設(shè)計(jì)
在小車的自動(dòng)控制模式下,單片機(jī)通過判斷4個(gè)尋跡模塊發(fā)送回來的不同信號(hào)進(jìn)行相應(yīng)的操作。整體的思路為:小車左偏則左輪的速度要大于右輪的速度小車才能恢復(fù)正常,小車右偏則右輪的速度要大于左輪的速度小車才能恢復(fù)正常,當(dāng)小車正常時(shí)兩側(cè)輪子的速度相同。由上面的分析可知速度的快慢可通過對(duì)L298使能端PWM值的控制進(jìn)行調(diào)節(jié)。通過多次調(diào)試可得出如表2所示的PWM數(shù)值。
4 MCU控制與算法實(shí)現(xiàn)
系統(tǒng)控制由微處理器完成,微處理器采用MSP430單片機(jī),當(dāng)單片機(jī)讀入傳感器的信號(hào)后即可判斷小車當(dāng)前的行駛狀態(tài),具體流程如圖4所示。
pwm相關(guān)文章:pwm是什么
c語言相關(guān)文章:c語言教程
評(píng)論