J Daniel Martinez C
/
SensoresUltrasonicosSRF05
Upaep
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); }