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:
5.1 Comprobando el funcionamiento de las ruedas
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