' ============================================================
' TOF2 雙眼雷射測距感應器 EV3 新手範例 03：避障車：看到東西就後退轉彎
' 軟體：clev3r
' 接法：TOF2 雙眼雷射插 1 號孔；左輪馬達接 B、右輪馬達接 C
' 這個範例會做什麼：車子一直往前開，前面太近就後退一點、原地轉一下，再繼續往前。放在有箱子的地上，它會自己繞開。
' 讀值：dist＝左右兩眼的平均距離（0 ~ 100（1 格＝1.2 公分，100＝前面沒東西））
' ============================================================
folder "prjs" "MBC_tof2_ex03"

' TOF2 雙眼雷射插 1 號孔，使用模式 0
Sensor.SetMode(1, 0)
LCD.Clear()

' 一直重複
While "True"
  ' 如果前面距離小於 25（約 30 公分）
  If Sensor.ReadRawValue(1, 0) < 25 Then
    ' 先後退
    Motor.StartPower("B", -30)
    Motor.StartPower("C", -30)
    ' 退 0.5 秒
    Program.Delay(500)
    ' 左輪往前、右輪往後：原地向右轉
    Motor.StartPower("B", 30)
    Motor.StartPower("C", -30)
    ' 轉 0.5 秒
    Program.Delay(500)
  Else
    ' 前面沒東西：往前開
    Motor.StartPower("B", 30)
    Motor.StartPower("C", 30)
  EndIf
EndWhile