Bom pessoal, estou me baseando nesse projeto:
http://labdegaragem.com/profiles/blogs/plataforma-robotica-magician...
Em vez do 4power, estou usando esse shield:
Tenho 2 motores dc ligado nele, funcionando perfeitamente, o sensor de curto alcance está funcionando também, o problema está no servo, creio que seja algo no código.
#include "MotorDriver.h"
#include <Servo.h> //Inclui biblioteca do Servo Motor
Servo limp; //Atribui "limp" para utilizar-se os comandos do servo motor
int sensorValue; //Variável para pegar o valor do Sensor de Proximidade
int vass = 3; //Atribui 9 para vass, onde o pino D9 (Digital 9) será utilizado para controlar o servo
void setup()
{
pinMode(vass, OUTPUT); //Atribui o pino D9 (vass) como saída
limp.attach(vass); //Vincula o pino D9 ao servo motor
limp.write(180); //Faz com que o servo motor gire sempre para o mesmo sentido
motordriver.init();
motordriver.setSpeed(200,MOTORB);
motordriver.setSpeed(200,MOTORA);
}
void loop()
{
sensorValue = analogRead(A5); //Lê o valor do sensor pelo pino A5 (Analogic Input 5) e guarda na variável
if (sensorValue > 150) //Se o valor do sensor for maior que 150 (Próximo a Parede) ele executa a girada
{
motordriver.goLeft();
delay(500); //Gira por 0,5 segundo
}
else
{
motordriver.goBackward();
delay(200);
}
}
O problema, é que o servo funciona e os motores DC nao, se eu comento as linhas:
// pinMode(vass, OUTPUT); //Atribui o pino D9 (vass) como saída
// limp.attach(vass); //Vincula o pino D9 ao servo motor
// limp.write(180); //Faz com que o servo motor gire sempre para o mesmo sentido
Os motores DC, voltam a funcionar.
No motor shield, os leds que indicam a posicao dos motores (frente, esquerda), piscam conforme distancia o sensor de curto alcance, mais os motores DC nao ligam.
Se alguém puder me ajudar.
Abraços.
Tags:
Bem-vindo a
Laboratorio de Garagem (arduino, eletrônica, robotica, hacking)
© 2024 Criado por Marcelo Rodrigues. Ativado por