Programação do Basic Stamp (Pbasic).  

'Robot Futebol 2X2

'Autores:Filipe Mimoso;Hugo Felicio;Luis Oliveira;Tiago Mendes

'Escola Secundaria Emidio Navarro - ALMADA

'*****************************************

'Especificacoes:

'pinos

'0 - motor esquerdo (stop - 140 / recua >140)

'1 - motor direito  (stop - 140 / recua <140)

'2 - bumper direito (0 activo/1 normal)

'3 - bumper esquerdo  (0 activo/ 1 normal)

'4 - sensor IV direito

'5 - sensor IV centro (0 nao detecta/1 detecta)

'6 - sensor IV esquerdo

'7 - sensor chao

'

'**********************

symbol bp_e=pin3

symbol bp_d=pin2

symbol sens_ch=pin7

symbol IV_d=pin4

symbol IV_e=pin6

symbol IV_c=pin5

symbol i=b1

symbol p=b2

p=1

inicio:

if bp_e=0 then rec_direita

if bp_d=0 then rec_esquerda

if IV_c=1 then avancar

if IV_e=1 then rodar_esquerda

if IV_d=1 then rodar_direita

if p=1 then rodar_esquerda

if p=2 then rodar_direita

'goto rodar_direita 

goto inicio

'**********************

avancar:

for i=1 to 50

pulsout 0,120

pulsout 1,160

next

goto inicio

'**********************

'**********************

recuar:

for i=1 to 10

pulsout 0,160

pulsout 1,120

next

goto inicio

'**********************

'**********************

esquerda:

etc...