{\rtf1\ansi\ansicpg1252\deff0\deflang1033{\fonttbl{\f0\fswiss\fcharset0 Arial;}} {\*\generator Msftedit 5.41.15.1515;}\viewkind4\uc1\pard\f0\fs20 ' \{$STAMP BS2p\}\par ' \{$PBASIC 2.5\}\par c VAR Word\par d VAR Word\par j VAR Word\par k VAR Word\par sweepcount VAR Word\par \par led PIN 5\par pingservo1 PIN 4\par \par sweep_start CON 625\par sweep_step CON 625\par sweep_stop CON 3125\par \par DEBUG "Start------------" , CR\par FOR j = 1 TO 5\par DEBUG ? j\par MAINIO\par HIGH led\par PAUSE 250\par LOW led\par PAUSE 250\par NEXT\par GOSUB centre_ping\par GOSUB check_ping\par DEBUG "End" , CR\par END\par \par check_ping:\par DEBUG "Inside check_ping" , CR\par FOR sweepcount = sweep_start TO sweep_stop STEP sweep_step\par DEBUG ? sweepcount\par FOR d = 1 TO 20\par PULSOUT PingServo1, sweepcount\par PAUSE 20\par NEXT\par PAUSE 20\par NEXT\par DEBUG "Finished check_ping" , CR\par RETURN\par \par centre_ping:\par DEBUG "Inside centre_ping:" , CR\par k = 1875\par FOR c = 1 TO 20\par FOR d = 1 TO 20\par PULSOUT PingServo1, 1875\par PAUSE 10\par NEXT\par PAUSE 10\par NEXT\par DEBUG "Finished centre_ping" ,CR\par RETURN\par }