陣法大師
2022第四屆科工館
Fixed Maze
固定迷宮
延伸集
mBot2 shield:mBot2車架、mBot2擴展接口。
Quad RGB Sensor(beta):四路顏色感測器。
主程式
變數宣告
變數宣告
法則:按下按鍵前調整節點數。
速度:決定循線的速度。
距離:超音波偵測距離。
偏移值:四路RGB回傳偏移量*比例常數Kp。
節點數:左手或右手法則預計要經過的節點數量。
Kp:比例常數。
Node:行走時經過的節點數。
初值化
初值化
變數的初值設定、舵機歸位、螢幕顯示提示字串。
入口
入口
入口出發由白色區進入背景區時的偵測。
分段加速階梯式
左手法則
左手法則
左邊優先、前面第二、右邊第三,否則迴轉。
※依下面規則,右手法則也不是難事:
右邊優先、前面第二、左邊第三,否則迴轉。
偵測隔板
偵測隔板
編程雙馬達控制
編程雙馬達控制
前進時,右輪必須與左輪反方向轉動。
前進節點
前進節點
出口
出口