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