Datasheet

Chapter 5: Debugging and Datalogging · Page 229
#IF DEBUG_MODE = 1 #THEN state = GF #ENDIF
maneuver = Forward ' 1 forward pulse
GOSUB Servos_And_Sensors
RETURN
' -----[ Subroutine - Track_Front_Left_Object ]-------------------------------
Track_Front_Left_Object:
#IF DEBUG_MODE = 1 #THEN state = TFLO #ENDIF
counter = 0
DO UNTIL (irLF = 1 AND irRF = 1) OR counter > 15
maneuver = CurveLeft ' Curve left 15
GOSUB Servos_And_Sensors
counter = counter + 1
LOOP
DO UNTIL (irLF = 1 AND irRF = 1) OR counter > 30
maneuver = RotateLeft ' Rotate left 30
GOSUB Servos_And_Sensors
counter = counter + 1
LOOP
RETURN
' -----[ Subroutine - Track_Front_Right_Object ]------------------------------
Track_Front_Right_Object:
#IF DEBUG_MODE = 1 #THEN state = TFRO #ENDIF
counter = 0
DO UNTIL (irLF = 1 AND irRF = 1) OR counter > 15
maneuver = CurveRight ' Curve right 15
GOSUB Servos_And_Sensors
counter = counter + 1
LOOP
DO UNTIL (irLF = 1 AND irRF = 1) OR counter > 30
maneuver = RotateRight ' Rotate right 30
GOSUB Servos_And_Sensors
counter = counter + 1
LOOP
RETURN
' -----[ Subroutine - Track_Side_Left_Object ]--------------------------------
Track_Side_Left_Object: