Upaep

Dependencies:   SRF05 mbed

main.cpp

Committer:
dan_cuspi
Date:
2013-10-21
Revision:
0:92ceb941f65e

File content as of revision 0:92ceb941f65e:

#include "mbed.h"

#include "mbed.h"
#include "SRF05.h"
              // Trigger  Echo
SRF05 srfIzquierdo(p11, p12);
SRF05 srf2Derecho(p13, p14);
SRF05 srf3Frontal(p15, p16);


//motor Izquierdo , atras y adelante
DigitalOut FernandoAdI(LED1);
DigitalOut FernandoAtI(LED2);
//motor derecho , atras y adelante
DigitalOut FernandoAdD(LED3);
DigitalOut FernandoAtD(LED4);

int main() { 
     while(1) { 
         printf("Distance = %.1f  %.1f  %.1f \n\r", srfIzquierdo.read(),srf2Derecho.read(),srf3Frontal.read()); 
          FernandoAdI=0;
           FernandoAtI=0;
           FernandoAdD=0;
           FernandoAtD=0;
            
        // Sensor Izquierdo
         if (srfIzquierdo.read()>15)//distancia de sensro mayor a 15
         {
         //motor Izquierdo
         FernandoAdI=1;   //input 1
         FernandoAtI=0;   //intput2
         //motor Derecho
         FernandoAdD=1;  //input3
         FernandoAtD=0;  //input 4
          }
          else
          {
          FernandoAdI=0;
         FernandoAtI=1;
         FernandoAdD=0;
         FernandoAtD=1;
          }
        
          
          }
          
        // wait(0.2); 
     }