En este nuevo paso de la construcción del robot, vamos a comprobar que las conexiones eléctricas entre la tarjeta y los servos son correctas. Es preciso que nos aseguremos de que el servo de la derecha gira cuando recibe señales procedentes de P13 y que el servo de la izquierda hace lo propio cuando recibe señales de P12 según el montaje realizado en el paso anterior.
En la siguiente imagen vemos nuestro robot con las indicaciones de posición que se seguirán de ahora en adelante para evitar confusiones:
Comprobando la rueda derecha
Vamos a ejecutar un sencillo programa para probar el servo conectado a la rueda derecha. Hará que la rueda gire en la dirección de las agujas del reloj durante 3 segundos, parará durante un segundo y, después, girará en sentido contrario durante otros 3 segundos.
- ‘ Programa de prueba de servos. Pruebaservoderecho.bs2
- ‘ El servo derecho gira en sentido horario 3s, se para 1s
- ‘ y vuelve a girar 3s en sentido antihorario
- ‘ {$STAMP BS2}
- ‘ {$PBASIC 2.5}
- Counter VAR Word
- FREQOUT 4, 2000, 3000 ‘señal de inicio/reset
- FOR counter = 1 TO 122 ‘giro horario durante 3s
- PULSOUT 13, 650
- PAUSE 20
- NEXT
- FOR counter = 1 TO 40 ‘parada 1s
- PULSOUT 13, 750
- PAUSE 20
- NEXT
- FOR counter = 1 TO 122 ‘giro antihorario durante 3s
- PULSOUT 13, 850
- PAUSE 20
- NEXT
- END
Para ponerlo en marcha, cargaremos el programa en el editor de Basic Stamp y lo introduciremos en la tarjeta del robot como hemos visto en pasos anteriores. Acto seguido colocamos el interruptor de energía en la posición 2 (que alimenta los servos) y ejecutamos el programa.
Los mismos pasos daremos con el servo de la rueda izquierda:
- ‘ Programa de prueba de servos. Pruebaservoderecho.bs2
- ‘ El servo derecho gira en sentido horario 3s, se para 1s
- ‘ y vuelve a girar 3s en sentido antihorario
- ‘ {$STAMP BS2}
- ‘ {$PBASIC 2.5}
- Counter VAR Word
- FREQOUT 4, 2000, 3000 ‘señal de inicio/reset
- FOR counter = 1 TO 122 ‘giro horario durante 3s
- PULSOUT 12, 650
- PAUSE 20
- NEXT
- FOR counter = 1 TO 40 ‘parada 1s
- PULSOUT 12, 750
- PAUSE 20
- NEXT
- FOR counter = 1 TO 122 ‘giro antihorario durante 3s
- PULSOUT 12, 850
- PAUSE 20
- NEXT
- END
Vemos cómo la única diferencia entre estos dos programas es que hemos sustituido el punto de enganche del servo derecho (P13) por el servo izquierdo (P12) en el segundo programa.
Ahora vamos a comprobar como el robot se mueve según las indicaciones de la programación: la rueda derecha girará en sentido horario durante tres segundos, se detendrá un segundo, y volverá a girar en sentido antihorario otros 3 segundos (lo mismo sucederá con la rueda izquierda).