Ajuda com Servo, Motor DC, Motor Shield, Sensor de curto alcance

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.

Exibições: 328

Responder esta

© 2024   Criado por Marcelo Rodrigues.   Ativado por

Badges  |  Relatar um incidente  |  Termos de serviço