Sensor de Velocidad

Primer Programa Utilizando el Sensor de Velocidad

 con Interrupciones

//++++++++++++++++++++++++++++++++++++++
//++++++++++++++++++++++++++++++++++++++
volatile int DER=0; 
volatile int IZQ=0;

void setup() {
  // put your setup code here, to run once:
  Serial.begin(9600);
  attachInterrupt(0,RUEDADER,RISING);//INT0 en pin2
  attachInterrupt(1,RUEDAIZQ,FALLING);//INT1 en pin3
}

void loop() {
  // put your main code here, to run repeatedly:
  delay(1000);
  Serial.print("Pulsos en Rueda Derecha=");
  Serial.println(DER);
  Serial.print("Pulsos en Rueda Izquierda=");
  Serial.println(IZQ);
  Serial.println("+/+/+/+/+/+/+/+/+/+/+/+");
  DER=0;
  IZQ=0;
}

void RUEDADER(){
  DER++;        //INCREMENTAR +1
}

void RUEDAIZQ(){
  IZQ++;        //INCREMENTAR +1
}
//++++++++++++++++++++++++++++++++++++++
//++++++++++++++++++++++++++++++++++++++

Les deseo mucho éxito

y sigamos programando!!!

Control de Motor con PWM

Hola a todos, hoy les voy a presentar como controlar la velocidad de  las ruedas en el ROBOTCAR, con esto vamos a corregir el avance que tenia el robot y lograremos que lo haga en linea recta.

El codigo es el siguiente:
//+++++++++++++++++++++++++++++++++++++++++++++
//+++++++++++++++++++++++++++++++++++++++++++++
int mp7=7;      //CONTROL MOTOR PIN7
int PWM_mp6=6;  //SALIDA PWM AL MOTOR IZQUIERDO
int PWM_mp5=5;  //SALIDA PWM AL MOTOR DERECHO
int mp4=4;      //CONTROL MOTOR PIN4

void setup() {
  // put your setup code here, to run once:
  pinMode(mp7,OUTPUT);
  pinMode(PWM_mp6,OUTPUT);
  pinMode(PWM_mp5,OUTPUT);
  pinMode(mp4,OUTPUT);

  digitalWrite(mp7,LOW);  //LOW=BAJO= 0 VOLTS 
  digitalWrite(mp4,LOW);  //LOW=BAJO= 0 VOLTS
}

void loop() {
  // put your main code here, to run repeatedly:
  analogWrite(PWM_mp6,150); //MOTOR IZQUIERDO
  analogWrite(PWM_mp5,255); //MOTOR DERECHO
}

//+++++++++++++++++++++++++++++++++++++++++++++

//+++++++++++++++++++++++++++++++++++++++++++++

Les deseo mucho éxito

y sigamos programando!!!

Sensor Detector de Sonido

Código y Vídeo Tutorial más abajo:

//++++++++++++++++++++++++++++++++++++++++++
//++++++++++++++++++++++++++++++++++++++++++
#define BUZZER 8
int MICROFONO=3;

int GREEN=A0;
int YELLOW=A1;
int RED=A2;

int VARX;
bool SONIDO= false;
unsigned long TIEMPO;


void setup(){
  pinMode(BUZZER,OUTPUT);
  pinMode(MICROFONO,INPUT);
  Serial.begin(9600);
  VARX=0;
  analogWrite(GREEN,255);
  delay(1000);
  analogWrite(RED,0);
  analogWrite(GREEN,0);
  analogWrite(YELLOW,0);
}

void loop(){
  SONIDO= digitalRead(MICROFONO);

  if((SONIDO==true) && (VARX==0)) 
  {
    //SONIDO=false;
    VARX++;
    TIEMPO= millis();
    delay (200);
  } 
  else if((SONIDO==true) && (VARX>0)) 
  {
    //SONIDO=false;
    VARX++;
    delay (200);
  } 
  

  if(((millis()-TIEMPO)>700) && (VARX>=1))
  { // Reseteamos estados al pasar 700 ms
    Serial.print("VarX=");
    Serial.println(VARX);
  
    switch (VARX){
      case 1:
          Serial.println("Turn On RED Led");
          tone(BUZZER,2000,300);
          analogWrite(RED,255);
          break;
      case 2:
          Serial.println("Turn On YELLOW Led");
          tone(BUZZER,700,300);
          analogWrite(YELLOW,255);
          break;
      case 3:        
          Serial.println("Turn On GREEN Led");
          analogWrite(GREEN,255);
          tone(BUZZER,300,300);
          break;
    }
    VARX=0;    
    delay(1000);
    analogWrite(RED,0);
    analogWrite(GREEN,0);
    analogWrite(YELLOW,0);
  }
}
//++++++++++++++++++++++++++++++++++++++++++
//++++++++++++++++++++++++++++++++++++++++++

Les deseo mucho éxito

y sigamos programando!!!