sexta-feira, 9 de setembro de 2011

Código Fonte para teste do sensor de chão digital (Sensor de linha, Infra vermelho)

/*  
  Sensor de Chão
  Programa para ler um sensor de linha
 */
int sinal = 2;   // Este é o pino de saída do sensor; 0 =  Baixo (LOW)  1 = Alto (HIGH)                                                                                     
int led = 13;    // Esta saída digital ser´usada para excitar o LED de teste.
int motor = 8;  // Caso você já tenha um motor para teste, use-o nesta porta. *
/*
  CUIDADO: Não é recomendável ligar motores CC diretamente ao Arduino
*/
int achouLinha = 0;      // Esta variável será usada para armazenar a leitura do sensor
// A função abaixo, é usada para configurar (iniciar) todas as variáveis
void setup()
{                
  pinMode(led, OUTPUT);          // Configura o pino do LED como saída para o Arduino
  pinMode(motor, OUTPUT);     // Configura o pino do MOTOR como saída para o Arduino
  pinMode(Sinal, INPUT);          // Configura o pino sensor como entrada para o Arduino
}


/*
  Esta é a função onde todas as rotinas de controle do robô, devem ser inseridas
*/
void loop() 
{
  achouLinha = digitalRead(sinal);    // Captura o estado do pino sensor
  if (achouLinha)                                 // Detectou a linha clara... 
  {
    digitalWrite(led, HIGH);               // Liga o LED
    digitalWrite(motor,HIGH);           // Ativa o MOTOR
  }
  else                                                   // Senão...
  {
    digitalWrite(led, LOW);                // Desliga o LED
    digitalWrite(motor,LOW);            // Desativa o MOTOR
  }
}

Nenhum comentário:

Postar um comentário