陣法大師

2022第四屆科工館

Fixed Maze

固定迷宮

延伸集

mBot2 shield:mBot2車架、mBot2擴展接口。

Quad RGB Sensor(beta):四路顏色感測器。

主程式

變數宣告

法則:按下按鍵前調整節點數。

速度:決定循線的速度。

距離:超音波偵測距離。

偏移值:四路RGB回傳偏移量*比例常數Kp。

節點數:左手或右手法則預計要經過的節點數量。

Kp:比例常數。

Node:行走時經過的節點數。

初值化

變數的初值設定、舵機歸位、螢幕顯示提示字串。

入口

入口出發由白色區進入背景區時的偵測。

分段加速階梯式

左手法則

左邊優先、前面第二、右邊第三,否則迴轉。

※依下面規則,右手法則也不是難事:

右邊優先、前面第二、左邊第三,否則迴轉。

偵測隔板

編程雙馬達控制

前進時,右輪必須與左輪反方向轉動。

前進節點

出口