Hacer un Robot hormiga (8 / 9 paso)

Paso 8: Programación de la hormiga Robot

Cómo funciona
En modo autónomo de recolección, el robot gira a la derecha en busca de un objeto. Si no encuentra nada que se detiene después de girar 360 grados. Cuando un objeto se detecta se detiene y corrige el sobre manejo y uso de la distancia medida por el objeto detectado, mueve hacia adelante una distancia específica. Luego se cierra la pinza y ascensores.

Control remoto
En modo control remoto el robot espera una señal para un movimiento como el avance o un comando en modo autónomo. Un estándar universal TV remote puede ser configurada para código de Sony TV que puede decodificar el Picaxe. El infrarrojo del control remoto es recibido por el módulo receptor de Panasonic.

Aquí está el código de programación para la hormiga robot:

' hormiga robot, Picaxe 20 x-2
que dirsc = % 00000000
setfreq m8
PAUSE 2000

' loop22: ' prueba de sensor de distancia infrarrojo
' readadc 7, b4
' depurar b4
' goto loop22

startreset: ' reset para iniciar
serout c.0,t2400 ($80, $01, $01,2,30)'set4 para servo #, set5 velocidad de 0to127
serout c.0,t2400,($80,$01,$04,2,26,30) ' cuerpo abajo 26
pausa de 200
serout c.0,t2400,($80,$01,$01,1,30) ' velocidad sistema # pasado de 0 a 127
serout c.0,t2400,($80,$01,$04,1,26,127) ' cerrar pinza 26
pausa de 200
serout c.0,t2400,($80,$01,$01,0,20) ' velocidad sistema # pasado de 0 a 127
serout c.0,t2400,($80,$01,$04,0,26,127) ' central centro
PAUSE 1000

loopinfra: ' control remoto de movimientos o secuencias autónomas
bajo c.1 ' ojo azul
c.2 alta ' ojo azul
c.5 de IRIN, b6
Si b6 = 0 entonces act1 ' remoto button1 = 0
Si b6 = 1 entonces c ' b2
Si b6 = 2 entonces act2 ' b3
Si b6 = 3 luego a la izquierda ' b4
Si b6 = 4 entonces stop1 ' b5
Si b6 = 5 luego a la derecha ' b6
Si b6 = 6 entonces act3 ' b7
Si b6 = 7 entonces rev1 ' b8
Si b6 = 8 entonces biteme ' ataque
' si b6 = 59 entonces biteme ' ataque
Si b6 = 11 then putdwn ' entrar poner abajo
Si b6 = 21 then startreset ' reset servos
' depurar b6
Goto loopinfra

Act1: ' hormiga robot lunas del mundo
GoSub forw2
PAUSE 2500
GoSub bodyup2
GoSub izquierda2
GoSub headleft2
PAUSE 300
GoSub forw2
hacer una pausa en 1200
stop2 GoSub
GoSub forw2
PAUSE 500
stop2 GoSub
GoSub headright2
c.1 alta ' ojo rojo l
c.2 la baja ' r de ojos rojos
PAUSE 1000
GoSub right2
PAUSE 2500
GoSub headcenter2
GoSub bodydwn2
GoSub rev2
PAUSE 2500
stop2 GoSub
GoSub leftfast
PAUSE 500
stop2 GoSub
GoSub rightfast
PAUSE 500
GoSub leftfast
PAUSE 500
stop2 GoSub
GoSub rightfast
PAUSE 500
stop2 GoSub
hacer una pausa en 2200
GoSub forw2
GoSub bodyup2
hacer una pausa en 3500
GoSub opengrip2
PAUSE 500
stop2 GoSub
Goto loopinfra

biteme:
GoSub forw2
B8 = 1
para b8 = 1 a 175
' encontrar obstáculo
c.2 alta ' ojo rojo l
c.1 la baja ' r de ojos rojos
readadc 7, b4
Si b4 > 60 y b4 < 135 luego next3
pausa de 30
siguiente b8
Goto loopinfra

Next3:
stop2 GoSub
GoSub bodydwn2
GoSub opengrip2
' pausa 100
GoSub bodyup2
GoSub forw2
PAUSE 300
GoSub closegrip2
hacer una pausa en 900
stop2 GoSub
GoSub rev2
GoSub bodydwn2
hacer una pausa en 6000
stop2 GoSub
Goto loopinfra

ACT2: ' recolección, putdown
' adelante
serout c.0,t2400,(128,0,1,100) ' adelante derecha 20min a 127
serout c.0,t2400,(128,0,2,100) ' hacia la izquierda 20min
hacer una pausa en 4500
stop2 GoSub
PAUSE 100

' encontrar bloque
B8 = 1
para b8 = 1 a 75

' encontrar bloque y recolección
c.2 alta
c.1 bajo
GoSub right2

readadc 7, b4
Si b4 > 61 y b4 < 164 entonces detect0 34-75

pausa de 50
siguiente b8
stop2 GoSub
Goto loopinfra

detect0: ' parar y corregir
stop2 GoSub
' gire a la izquierda lenta
serout c.0,t2400,(128,0,1,60) ' adelante derecha 20min a 127
serout c.0,t2400,(128,0,3,60) ' rev 20 minutos a la izquierda
pausa de 240
stop2 GoSub
PAUSE 100
c.2 la baja ' ojo rojo
c.1 alta ' ojo rojo

' adelante, recolección
GoSub opengrip2
PAUSE 1000
GoSub forw2
Si b4 < 50 entonces pa1
Si b4 < 60 entonces pa2
Si b4 < 70 entonces pa3
Si b4 < 80 entonces pa4
Si b4 < 90 entonces PE5
Si b4 < 104 entonces pa6
PA1:
pausa 9000
Goto stopat

PA2:
pausa 5920
Goto stopat

PA3:
hacer una pausa en 3800
Goto stopat

PA4:
pausa 2800
Goto stopat

PE5:
hacer una pausa en 2100
Goto stopat

PA6:
pausa 980
Goto stopat

STOPAT:
stop2 GoSub
pausa de 200

' closegrip
serout c.0,t2400,($80,$01,$01,1,30) ' # última juego de velocidad de 0 a 127
serout c.0,t2400,($80,$01,$04,1,26,127) ' cerrar pinza 26
PAUSE 2000
GoSub bodyup2

' putdown
GoSub leftfast
hacer una pausa en 1400
stop2 GoSub
GoSub forw2
hacer una pausa en 1800
stop2 GoSub
GoSub bodydwn2
GoSub opengrip2
PAUSE 500

' miradas
GoSub rev2
PAUSE 2000
stop2 GoSub
GoSub bodyup2
GoSub headleft2
GoSub headright2
GoSub headcenter2
bajo c.1 ' ojo azul
c.2 alta ' ojo azul
Goto loopinfra

act3: ' Abra la pinza y adelante
' adelante, recolección
GoSub opengrip2
PAUSE 400
GoSub forw2
pausa de 280
stop2 GoSub
Goto loopinfra

act4: ' cerrar la pinza y elevación
GoSub closegrip2
hacer una pausa en 600
GoSub bodyup2

Goto loopinfra

' ' *** gosubs

leftslow:
' gire a la izquierda lenta
serout c.0,t2400,(128,0,1,60) ' adelante derecha 20min a 127
serout c.0,t2400,(128,0,3,60) ' rev 20 minutos a la izquierda
pausa 220
stop2 GoSub
volver

stop2:
serout c.0,t2400,(128,0,0,0) ' dura parada derecha
serout c.0,t2400,(128,0,6,0) ' izquierda dura parada
volver

forw2:
serout c.0,t2400,(128,0,1,100) ' adelante derecha 20min a 127
serout c.0,t2400,(128,0,2,100) ' hacia la izquierda 20min
volver

izquierda2:
serout c.0,t2400,(128,0,1,100) ' adelante derecha 20 minutos
serout c.0,t2400,(128,0,3,100) ' rev 20 minutos a la izquierda
volver

right2:
serout c.0,t2400,(128,0,2,100) ' hacia la izquierda 20min
serout c.0,t2400,(128,0,0,100) ' rev derecha 20 minutos
volver

Rev2:
' dejar de
serout c.0,t2400,(128,0,0,0) ' dura parada derecha
serout c.0,t2400,(128,0,6,0) ' izquierda dura parada
pausa de 50
' inversa
serout c.0,t2400,(128,0,0,100) ' rev derecha 20 minutos
serout c.0,t2400,(128,0,3,100) ' rev 20 minutos a la izquierda
volver

opengrip2:
serout c.0,t2400 ($80, $01, $01,1,30)'set4 para servo #, set5 velocidad de 0to127
serout c.0,t2400,($80,$01,$04,1,13,127) ' abrir la pinza, 13
PAUSE 1000
volver

closegrip2:
serout c.0,t2400,($80,$01,$01,1,30) ' velocidad sistema # pasado de 0 a 127
serout c.0,t2400,($80,$01,$04,1,26,127) ' cerrar pinza 26
PAUSE 2000
volver

headleft2:
serout c.0,t2400 ($80, $01, $01,0,20)'set4 para servo #, set5 velocidad de 0to127
serout c.0,t2400,($80,$01,$04,0,15,127) ' cabeza izquierda 15
hacer una pausa en 800
volver

headright2:
' c.0,t2400,($80,$01,$01,0,20) serout ' velocidad sistema # pasado de 0 a 127
serout c.0,t2400,($80,$01,$04,0,32,127) ' cabeza derecha 30
hacer una pausa en 1600
volver

headcenter2:
serout c.0,t2400,($80,$01,$01,0,20) ' velocidad sistema # pasado de 0 a 127
serout c.0,t2400,($80,$01,$04,0,26,127) ' central centro
PAUSE 500
volver

bodyup2:
serout c.0,t2400 ($80, $01, $01,2,30)'set4 para servo #, set5 velocidad de 0to127
serout c.0,t2400,($80,$01,$04,2,13,30) ' cuerpo para arriba, 13
pausa 220
volver

bodydwn2:
serout c.0,t2400 ($80, $01, $01,2,30)'set4 para servo #, set5 velocidad de 0to127
serout c.0,t2400,($80,$01,$04,2,26,30) ' cuerpo abajo 26
pausa de 200
volver

leftfast:
serout c.0,t2400,(128,0,1,127) ' adelante derecha 20 minutos
serout c.0,t2400,(128,0,3,127) ' rev 20 minutos a la izquierda
volver

rightfast:
serout c.0,t2400,(128,0,2,127) ' hacia la izquierda 20min
serout c.0,t2400,(128,0,0,127) ' rev derecha 20 minutos
volver

Artículos Relacionados

Hacer un robot simple de RF inalámbrico con Arduino!

Hacer un robot simple de RF inalámbrico con Arduino!

ACTUALIZACIÓN: HE AÑADIDO CONTROL DE JOYSTICK A ESTE ROBOT. POR FAVOR CONSULTE EL PASO 7 SI DESEA CONTROLAR EL ROBOT POR MEDIO DE JOYSTICK.Hola,Este es mi primer instructivo y en este tutorial voy a mostrarte, cómo construir un simple robot inalámbri
Cómo hacer un robot muy simple

Cómo hacer un robot muy simple

este es mi 1 º instructable, así que por favor me diga si es bueno.así que va a mostrar cómo hacer un robot muy simple: el robot escarabajo!usa sin chip, sin programación, sólo la simple conexión 3Paso 1: obtener todos los materiales necesarios! ok a
Cómo hacer un robot por menos de 120$

Cómo hacer un robot por menos de 120$

Hola, este es mi instructable: "cómo hacer un robot por menos de 120$" Tengo 13 años y quería construir un robot pero no tengo dinero suficiente para comprar un drone de rtf (listo para volar) que mis necesidades así que le dije a mi hermano vam
Hacer un Robot inalámbrico con un teléfono con Android

Hacer un Robot inalámbrico con un teléfono con Android

En este Instructable vamos a construir un MouseBot.El MouseBot es un robot pequeño arduino wireless que se puede controlar con un ordenador. No requiere un módulo Wi-Fi. En su lugar utiliza un teléfono con android para conectarse a internet. El teléf
Cómo hacer un robot de batalla KVG ganador

Cómo hacer un robot de batalla KVG ganador

he estado en varios concursos de KVG batalla bot. Cada vez que aprendo algunas cosas nuevas sobre cómo hacer un bot ganador de la batalla. Resumir los conceptos básicos y me enseñará a hacer un robot de batalla eficaz pieza.Lo principal para recordar
Cómo hacer un robot para niños (centinela)

Cómo hacer un robot para niños (centinela)

Definitivamente que se dedique a robótica, quiere hacer un robot. ¿Y surge inmediatamente la pregunta, cómo hacer un robot con sus propias manos? Para crear un robot necesita una variedad de un componentes de radio de dificultad. También, para la con
Cómo hacer un Robot Meca-pingüino

Cómo hacer un Robot Meca-pingüino

Recientemente, he investigado y encontrado nuevas formas de jugar con el coche de la robusteza de mBot , cómo hacer más interesante el coche robot lindo y lograr más funciones. mBot es un kit de robot educativo, es fácil de montar en 20 minutos y pue
Hacer un robot humanoide de bajo costo de material de la tubería de agua de PVC (actualización)

Hacer un robot humanoide de bajo costo de material de la tubería de agua de PVC (actualización)

Este es mi primer robot humanoide que puede hablar, ver, caminar, bailar y cualquier otra cosa... el marco todo cuerpo está utilizando un material de tubería de agua delgada de pvc que tiene flated. se trata de cómo a flatted la tubería de agua pvcro
Hacer un Robot con Arduino UNO de uno mismo-equilibrio

Hacer un Robot con Arduino UNO de uno mismo-equilibrio

Uno mismo-equilibrio Robot es muy interesante. Muchos amigos que nos rodean estaban tratando de hacer uno, pero encounted muchos desafíos, incluyendo la falta de las estructuras de fácil montaje, los circuitos electrónicos adecuados y los programas.
Hacer un Robot de tazón de dulces (utilizando una palanca de mando)

Hacer un Robot de tazón de dulces (utilizando una palanca de mando)

no saben lo que está mal con mis caramelos de café colombiano. Llevé una bolsa de mi país y nadie quiso comer. En la oficina dijeron que son cautelosos con los caramelos porque están acostumbrados a ver proyectos locos y extraños caramelos. Incluso t
Cómo hacer un robot de Lego vibrante

Cómo hacer un robot de Lego vibrante

Hola, me llamo Aiyana y voy a mostrar o enseñar cómo hacer un robot de Lego vibrante. Tenía esta idea originaria de Cesar Harada instructable así he intentado hacer algo parecido con el Sr. Stanley y matón de la escuela de puerto, Hong Kong.Esto es a
Cómo hackear un controlador inalámbrico de la Xbox para hacer un robot autónomo!

Cómo hackear un controlador inalámbrico de la Xbox para hacer un robot autónomo!

Introduction:Este proyecto surgió al tratar de hacer un robot autónomo de bajo costo para uso enEducación. La idea es que los estudiantes serían capaces de identificar con el controlador de Xboxy disfruta de hacking en algo mucho más interesante!Un d
Hacer un robot escarabajo miedo

Hacer un robot escarabajo miedo

Grupo 18 +.¡ Hola! Este robot era originalmente un control remoto de juguete llamado el Scarab. Había quitado la tripa y substituido los cerebros con el EZ-B Bluetooth Robot controlador.¿Por lo tanto, usted quiere hacer un robot para flipar de tu nov
Cómo hacer un Robot de 2WD Makeblock mando

Cómo hacer un Robot de 2WD Makeblock mando

Makeblock mando 2WD Robot es un robot de Makeblock simple. Es fácil de construir y controlar. Usamos un control remoto por infrarrojos para controlar este robot.Si has comprado el kit con zócalo Me ir a visitar la siguiente página de instrucciones:-Z