Page 126 - Amphibionics : Build Your Own Biologically Inspired Robot

Amphibionics 04 3/24/03 8:24 AM Page 105
Chapter 4 / Frogbotic: Build Your Own Robotic Frog
switch_l VAR PORTA.3
led_l VAR PORTB.1
frog-test.bas program
listing (continued)
led_r VAR PORTB.0 PROGRAM 4.1
piezo VAR PORTB.4
'------------------------------------------------------------------------------------------------------------------------------
low servo_l
low servo_r
start:

for temp1 = 1 to 10
SOUND piezo, [80,4,100,2]
low led_l
low led_r
pause 50
high led_l
high led_r
next temp1

SOUND piezo, [100,4,120,2,80,2,90,2]

low led_l
low led_r

rotate:

servo_pos_r = 170
gosub right_servo

servo_pos_l = 130
gosub left_servo

goto rotate

'------------------------------------------------------------------------------------------------------------------------------
' subroutines to set servos

105