' =========================================================================
'
'   File....... SERVO_TEST.BSP
'   Purpose....
'   Author..... Jon Williams -- Parallax, Inc.
'   E-mail..... jwilliams@parallax.com
'   Started....
'   Updated.... DD MMM YYYY
'
'   {$STAMP BS2}
'   {$PBASIC 2.5}
'
' =========================================================================


' -----[ Program Description ]---------------------------------------------


' -----[ Revision History ]------------------------------------------------


' -----[ I/O Definitions ]-------------------------------------------------

SCin            PIN     14                      ' from servo controller
SCout           PIN     15                      ' to servo controller


' -----[ Constants ]-------------------------------------------------------

#SELECT $STAMP
  #CASE BS2, BS2E, BS2PE
    T1200       CON     813
    T2400       CON     396
    T4800       CON     188
    T9600       CON     84
    T19K2       CON     32
    TMidi       CON     12
    T38K4       CON     6
  #CASE BS2SX, BS2P
    T1200       CON     2063
    T2400       CON     1021
    T4800       CON     500
    T9600       CON     240
    T19K2       CON     110
    TMidi       CON     60
    T38K4       CON     45
#ENDSELECT

SevenBit        CON     $2000
Inverted        CON     $4000
Open            CON     $8000

Baud            CON     T9600


' -----[ Variables ]-------------------------------------------------------

pos             VAR     Byte
reported        VAR     Byte


' -----[ EEPROM Data ]-----------------------------------------------------


' -----[ Initialization ]--------------------------------------------------

Reset:


' -----[ Program Code ]----------------------------------------------------

Main:
  DO
    FOR pos = 1 TO 255
      SEROUT SCout, Baud, [">11a", pos]
      PAUSE 10
      SEROUT SCout, Baud, [">11g"]
      SERIN  SCin, Baud, [reported]
      DEBUG DEC3 pos, TAB, DEC3 reported, CR
      PAUSE 25
    NEXT
  LOOP

  END


' -----[ Subroutines ]----------------------------------------------------- 