![](/media/cache/img/default_profile.jpg.50x50_q85.jpg)
This program is designed for control a VTOL plant at Mines Faculty - National University of Colombia.
Dependencies: DebouncedIn PID QEI SRF05 TextLCD mbed
Fork of SensoresUltrasonicosSRF05 by
main.cpp
- Committer:
- dan_cuspi
- Date:
- 2013-10-21
- Revision:
- 0:92ceb941f65e
- Child:
- 1:ad1952c5a3d7
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); }