買書捐殘盟

2010年2月2日 星期二

簡單的line_follower設計


一、nxt機器人要做line follow,考慮用robolab設計時,我使用了2顆nxt light sensor做為感測元件,裝置的位置如下:
2個感測元件在黑色電工膠帶的兩側白色區域。

二、程式設計原理:
1.使用task split的方式,讓sensor-2和sensor-3獨立判讀
2.當sensor-2偵測在白色區域:Motor-B 前進(forward)
 當sensor-2偵測在黑色區域:Motor-B後退(Backward)
3.當sensor-3偵測在白色區域:Motor-C 前進(forward)
 當sensor-3偵測在黑色區域:Motor-C後退(Backward)

三、本程式僅對單純的直角轉彎(沒有叉路)的應用,可有良好的表現。

四、程式碼:


沒有留言:

張貼留言