GOSUB Arm_Up
Arm_Test:
  GOSUB Forwards
  PAUSE 2000
  GOSUB Freeze
  GOSUB Arm_Down
  PAUSE 1000
  GOSUB Arm_Up
  GOSUB Left
  PAUSE 750
  GOSUB Freeze
  PAUSE 500
  GOTO Arm_Test

Left:
  HIGH 2
  LOW 3
  LOW 4
  HIGH 5
  RETURN

Right:
  LOW 2
  HIGH 3
  HIGH 4
  LOW 5
  RETURN

Backwards:
  HIGH 2
  LOW 3
  HIGH 4
  LOW 5
  RETURN

Forwards:
  LOW 2
  HIGH 3
  LOW 4
  HIGH 5
  RETURN

Freeze:
  HIGH 2
  HIGH 3
  HIGH 4
  HIGH 5
  PAUSE 500
  RETURN

Drop_Ball:
  SERVO 1,160                   ' arm at mid point
  PAUSE 1000
  RETURN

Arm_Down:                       ' arm all the way down
  SERVO 1, 175
  PAUSE 1000
  RETURN

Arm_Up:                         ' arm all the way up
  SERVO 1,140
  PAUSE 1000
  RETURN