J Daniel Martinez C / Mbed 2 deprecated SensoresUltrasonicosSRF05

Upaep

Dependencies:   SRF05 mbed

main.cpp@0:92ceb941f65e, 2013-10-21 (annotated)

Committer:
dan_cuspi
Date:
Mon Oct 21 16:03:20 2013 +0000
Revision:
0:92ceb941f65e
Sensor Ultrasonico SRF015

Who changed what in which revision?

UserRevisionLine numberNew contents of line
dan_cuspi 0:92ceb941f65e 1 #include "mbed.h"
dan_cuspi 0:92ceb941f65e 2
dan_cuspi 0:92ceb941f65e 3 #include "mbed.h"
dan_cuspi 0:92ceb941f65e 4 #include "SRF05.h"
dan_cuspi 0:92ceb941f65e 5 // Trigger Echo
dan_cuspi 0:92ceb941f65e 6 SRF05 srfIzquierdo(p11, p12);
dan_cuspi 0:92ceb941f65e 7 SRF05 srf2Derecho(p13, p14);
dan_cuspi 0:92ceb941f65e 8 SRF05 srf3Frontal(p15, p16);
dan_cuspi 0:92ceb941f65e 9
dan_cuspi 0:92ceb941f65e 10
dan_cuspi 0:92ceb941f65e 11 //motor Izquierdo , atras y adelante
dan_cuspi 0:92ceb941f65e 12 DigitalOut FernandoAdI(LED1);
dan_cuspi 0:92ceb941f65e 13 DigitalOut FernandoAtI(LED2);
dan_cuspi 0:92ceb941f65e 14 //motor derecho , atras y adelante
dan_cuspi 0:92ceb941f65e 15 DigitalOut FernandoAdD(LED3);
dan_cuspi 0:92ceb941f65e 16 DigitalOut FernandoAtD(LED4);
dan_cuspi 0:92ceb941f65e 17
dan_cuspi 0:92ceb941f65e 18 int main() {
dan_cuspi 0:92ceb941f65e 19 while(1) {
dan_cuspi 0:92ceb941f65e 20 printf("Distance = %.1f %.1f %.1f \n\r", srfIzquierdo.read(),srf2Derecho.read(),srf3Frontal.read());
dan_cuspi 0:92ceb941f65e 21 FernandoAdI=0;
dan_cuspi 0:92ceb941f65e 22 FernandoAtI=0;
dan_cuspi 0:92ceb941f65e 23 FernandoAdD=0;
dan_cuspi 0:92ceb941f65e 24 FernandoAtD=0;
dan_cuspi 0:92ceb941f65e 25
dan_cuspi 0:92ceb941f65e 26 // Sensor Izquierdo
dan_cuspi 0:92ceb941f65e 27 if (srfIzquierdo.read()>15)//distancia de sensro mayor a 15
dan_cuspi 0:92ceb941f65e 28 {
dan_cuspi 0:92ceb941f65e 29 //motor Izquierdo
dan_cuspi 0:92ceb941f65e 30 FernandoAdI=1; //input 1
dan_cuspi 0:92ceb941f65e 31 FernandoAtI=0; //intput2
dan_cuspi 0:92ceb941f65e 32 //motor Derecho
dan_cuspi 0:92ceb941f65e 33 FernandoAdD=1; //input3
dan_cuspi 0:92ceb941f65e 34 FernandoAtD=0; //input 4
dan_cuspi 0:92ceb941f65e 35 }
dan_cuspi 0:92ceb941f65e 36 else
dan_cuspi 0:92ceb941f65e 37 {
dan_cuspi 0:92ceb941f65e 38 FernandoAdI=0;
dan_cuspi 0:92ceb941f65e 39 FernandoAtI=1;
dan_cuspi 0:92ceb941f65e 40 FernandoAdD=0;
dan_cuspi 0:92ceb941f65e 41 FernandoAtD=1;
dan_cuspi 0:92ceb941f65e 42 }
dan_cuspi 0:92ceb941f65e 43
dan_cuspi 0:92ceb941f65e 44
dan_cuspi 0:92ceb941f65e 45 }
dan_cuspi 0:92ceb941f65e 46
dan_cuspi 0:92ceb941f65e 47 // wait(0.2);
dan_cuspi 0:92ceb941f65e 48 }
dan_cuspi 0:92ceb941f65e 49