Datasheet

Chapter 5: Debugging and Datalogging · Page 231
GOSUB Servos_And_Sensors
IF sensors <> 0 THEN GOTO Next_State
NEXT
Next_State: ' Exit point of search pattern
RETURN
' -----[ Subroutine - Display_All ]-------------------------------------------
#IF DEBUG_MODE = 1 #THEN
Display_All:
DEBUG BIN8 sensors, ' Display sensors byte as bits
CRSRX, 10 ' Cursor to column 10
SELECT state ' Display state
CASE ATL
DEBUG "ATL"
CASE ATR
DEBUG "ATR"
CASE GF
DEBUG "GF"
CASE TFLO
DEBUG "TFLO"
CASE TFRO
DEBUG "TFRO"
CASE TSLO
DEBUG "TSLO"
CASE TSRO
DEBUG "TSRO"
CASE SP
DEBUG "SP"
ENDSELECT
DEBUG CRSRX, 20 ' Cursor to column 20
SELECT maneuver ' Display maneuver
CASE Forward
DEBUG "Fwd"
CASE Backward
DEBUG "Bkwd"
CASE RotateLeft
DEBUG "RotLft"
CASE RotateRight
DEBUG "RotRt"
CASE CurveLeft
DEBUG "CrvLft"
CASE CurveRight
DEBUG "CrvRt"