Robot 4 patas (Parte 3)

A continuación está el programa del robot. Este programa genera movimientos a los motores que unidos a las patas simula el movimiento de un animal.

'Programa robot OCEANO
'*****************************
'
'        PLACA Propia
'
'*****************************
'Salidas:    Servo: 7-6-5-4-3-2-1-0           PataAbajo   PataCentro  PataArriba
'        7: pata delantera izquierda        160        130        100       
'        6: pata delantera derecha        100        130        160
'        5: pata trasera izquierda        100        130        160
'        4: pata trasera derecha            160        130        100
'        3: libre
'        2: libre
'        1: libre
'        0: libre
'       

symbol t=3

inicio:

'Equilibrio
servo 7, 130
servo 6, 130
servo 5, 130
servo 4, 130
wait t

'Baja las patas (sube el robot)
for b0=0 to 30
    b1=130+b0
    b2=130-b0
    servo 7,b1
    servo 6,b2
    servo 5,b2
    servo 4,b1
    servo 3,130    'evita saltos
    pause 100
next b0 

'Equilibrio
servo 7, 130
servo 6, 130
servo 5, 130
servo 4, 130
wait t

'Subir patas despacio
for b0=0 to 60
    b1=130-b0
    b2=130+b0
    servo 7,b1
    servo 6,b2
    servo 5,b2
    servo 4,b1
    servo 3,130    'evita saltos
    pause 80
next b0 

'Patas tocando horizontal
servo 7, 70
servo 6, 190
servo 5, 190
servo 4, 70
wait t

'Patas tocando horizontal
servo 7, 100
servo 6, 160
servo 5, 160
servo 4, 100
pause 1500

'Patas tocando horizontal
servo 7, 130
servo 6, 130
servo 5, 130
servo 4, 130
pause 1500

servo 7, 160
servo 6, 100
servo 5, 100
servo 4, 160
pause 1500

servo 7, 110
servo 6, 150
servo 5, 150
servo 4, 110
pause 1500

servo 7, 160
servo 6, 100
servo 5, 100
servo 4, 160
pause 1500

servo 7, 110
servo 6, 150
servo 5, 150
servo 4, 110
pause 1500

servo 7, 160
servo 6, 100
servo 5, 100
servo 4, 160
pause 1500

goto inicio


Para más información sobre la realización de la placa o sobre la programación ponerse en contacto a través del blog.