Lecturas de SRF05
Dependencies: DebouncedIn PID QEI SRF05 TextLCD mbed
Fork of SensoresUltrasonicosSRF05 by
main.cpp@0:92ceb941f65e, 2013-10-21 (annotated)
- Committer:
- dan_cuspi
- Date:
- Mon Oct 21 16:03:20 2013 +0000
- Revision:
- 0:92ceb941f65e
- Child:
- 1:a24d4814cc4a
Sensor Ultrasonico SRF015
Who changed what in which revision?
User | Revision | Line number | New 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 |