Steven Jiménez / Mbed 2 deprecated SRF05_VTOL

Lecturas de SRF05

Dependencies:   DebouncedIn PID QEI SRF05 TextLCD mbed

Fork of SensoresUltrasonicosSRF05 by J Daniel Martinez C

main.cpp@1:a24d4814cc4a, 2015-04-25 (annotated)

Committer:
stevenjigo
Date:
Sat Apr 25 13:53:20 2015 +0000
Revision:
1:a24d4814cc4a
Parent:
0:92ceb941f65e 
Lectura SRF05

Who changed what in which revision?

UserRevisionLine numberNew contents of line
dan_cuspi 0:92ceb941f65e 1 #include "mbed.h"
dan_cuspi 0:92ceb941f65e 2 #include "SRF05.h"
stevenjigo 1:a24d4814cc4a 3 #include "QEI.h"
stevenjigo 1:a24d4814cc4a 4 #include "TextLCD.h"
stevenjigo 1:a24d4814cc4a 5 #include <math.h>
stevenjigo 1:a24d4814cc4a 6 #include "DebouncedIn.h"
dan_cuspi 0:92ceb941f65e 7
stevenjigo 1:a24d4814cc4a 8 SRF05 srf(PTD0, PTD5);
stevenjigo 1:a24d4814cc4a 9 TextLCD lcd(PTB10, PTB11, PTE2, PTE3, PTE4, PTE5); // rs, e, d4-d7
stevenjigo 1:a24d4814cc4a 10 QEI encoder (PTD7, PTD6, NC, 1);
stevenjigo 1:a24d4814cc4a 11 DebouncedIn Pulsador(PTA17);
stevenjigo 1:a24d4814cc4a 12 PwmOut myled(LED1);
stevenjigo 1:a24d4814cc4a 13
stevenjigo 1:a24d4814cc4a 14 // Definición de comandos para LCD
stevenjigo 1:a24d4814cc4a 15
stevenjigo 1:a24d4814cc4a 16 int C2=0x18; // desplaza izquierda
stevenjigo 1:a24d4814cc4a 17 int C3=0x1A; // desplaza derecha
stevenjigo 1:a24d4814cc4a 18 int C4=0x0C; // quito cursor bajo
stevenjigo 1:a24d4814cc4a 19 int C1=0x0F;
stevenjigo 1:a24d4814cc4a 20 float val;
dan_cuspi 0:92ceb941f65e 21
stevenjigo 1:a24d4814cc4a 22 int main() {
stevenjigo 1:a24d4814cc4a 23 lcd.cls();
stevenjigo 1:a24d4814cc4a 24 lcd.locate(0,0);
stevenjigo 1:a24d4814cc4a 25 lcd.printf("Bienvenido");
stevenjigo 1:a24d4814cc4a 26 wait(1);
stevenjigo 1:a24d4814cc4a 27 lcd.cls();
stevenjigo 1:a24d4814cc4a 28 lcd.locate(0,0);
stevenjigo 1:a24d4814cc4a 29 lcd.printf("Distancia");
stevenjigo 1:a24d4814cc4a 30
stevenjigo 1:a24d4814cc4a 31 // //Analog input from 0.0 to 3.3V
stevenjigo 1:a24d4814cc4a 32 // controller.setInputLimits(0.0, 3.3);
stevenjigo 1:a24d4814cc4a 33 // //Pwm output from 0.0 to 1.0
stevenjigo 1:a24d4814cc4a 34 // controller.setOutputLimits(0.0, 1.0);
stevenjigo 1:a24d4814cc4a 35 // //If there's a bias.
stevenjigo 1:a24d4814cc4a 36 // controller.setBias(0.3);
stevenjigo 1:a24d4814cc4a 37 // controller.setMode(AUTO_MODE);
stevenjigo 1:a24d4814cc4a 38 // //We want the process variable to be 1.7V
stevenjigo 1:a24d4814cc4a 39 // controller.setSetPoint(1.7);
stevenjigo 1:a24d4814cc4a 40
stevenjigo 1:a24d4814cc4a 41 while(1) {
stevenjigo 1:a24d4814cc4a 42 lcd.locate(0,1);
stevenjigo 1:a24d4814cc4a 43 lcd.printf("%.2f\n", srf.read());
stevenjigo 1:a24d4814cc4a 44 myled=srf.read()*0.01;
stevenjigo 1:a24d4814cc4a 45 wait_ms(100);
dan_cuspi 0:92ceb941f65e 46 }
stevenjigo 1:a24d4814cc4a 47 }
dan_cuspi 0:92ceb941f65e 48