' {$STAMP BS2}
' {$PBASIC 2.5}

' ************************
' * Servo Positions      *
' ************************
  sPan          CON 0 ' Servo For Testing
  sTilt         CON 1 ' Servo For Testing

  PanSpeed      CON 20 ' Set the step rate
  PanRight      CON 900 ' PWN value to move servo to "right" position
  PanLeft       CON 500  ' PWM for Left

  TiltTop       CON 1000
  TiltBot       CON 700
  TiltSpeed     CON 10

  PauseTime     CON 20

' ************************
' * Data Variables       *
' ************************
  posx         VAR Word  ' For loop variable
  posy         VAR Word
  loopy        VAR Word
PAUSE 2000 ' Pause 10 seconds to allow camera to open shutter

FOR posy = tilttop TO tiltbot STEP tiltspeed
  FOR loopy = 0 TO PauseTime STEP 1
    PULSOUT sPan,PanLeft
    PULSOUT sTilt,posy
    PAUSE 20
  NEXT
  FOR loopy = 0 TO PauseTime STEP 1
    PULSOUT sPan, PanRight
    PULSOUT sTilt, posy
    PAUSE 20
  NEXT
NEXT



FOR posx = panleft TO panright STEP tiltspeed
  FOR loopy = 0 TO PauseTime STEP 1
    PULSOUT sPan,posx
    PULSOUT sTilt,TiltTop
    PAUSE 20
  NEXT
  FOR loopy = 0 TO PauseTime STEP 1
    PULSOUT sPan, posx
    PULSOUT sTilt, TiltBot
    PAUSE 20
  NEXT
NEXT