han back / Mbed OS CLEO_ULTRASONIC

SMART CLEO Ultrasonic

main.cpp@0:e7c4d23dbc05, 2017-09-28 (annotated)

Committer:
SMART_CLEO
Date:
Thu Sep 28 03:44:12 2017 +0000
Revision:
0:e7c4d23dbc05
SMART_CLEO

Who changed what in which revision?

UserRevisionLine numberNew contents of line
SMART_CLEO 0:e7c4d23dbc05 1 #include "mbed.h"
SMART_CLEO 0:e7c4d23dbc05 2 #include "TextLCD.h"
SMART_CLEO 0:e7c4d23dbc05 3 #include "HCSR04.h"
SMART_CLEO 0:e7c4d23dbc05 4
SMART_CLEO 0:e7c4d23dbc05 5 PinName pin_ECHO = PB_7;
SMART_CLEO 0:e7c4d23dbc05 6 PinName pin_TRIG = PB_10;
SMART_CLEO 0:e7c4d23dbc05 7
SMART_CLEO 0:e7c4d23dbc05 8 HCSR04 Ultrasonic(pin_ECHO, pin_TRIG);
SMART_CLEO 0:e7c4d23dbc05 9
SMART_CLEO 0:e7c4d23dbc05 10 // rs, rw, e, d0-d3
SMART_CLEO 0:e7c4d23dbc05 11 TextLCD lcd(PB_12, PB_13, PB_14, PB_15, PA_9, PA_10, PA_11);
SMART_CLEO 0:e7c4d23dbc05 12
SMART_CLEO 0:e7c4d23dbc05 13 float Ultrasonic_cm(void);
SMART_CLEO 0:e7c4d23dbc05 14
SMART_CLEO 0:e7c4d23dbc05 15 int main() {
SMART_CLEO 0:e7c4d23dbc05 16 uint16_t dist = 0;
SMART_CLEO 0:e7c4d23dbc05 17
SMART_CLEO 0:e7c4d23dbc05 18 lcd.printf(" Ultrasonic\n");
SMART_CLEO 0:e7c4d23dbc05 19 lcd.printf(" Dist : [cm]");
SMART_CLEO 0:e7c4d23dbc05 20
SMART_CLEO 0:e7c4d23dbc05 21 while(1) {
SMART_CLEO 0:e7c4d23dbc05 22 dist = Ultrasonic_cm();
SMART_CLEO 0:e7c4d23dbc05 23 lcd.locate(8, 1);
SMART_CLEO 0:e7c4d23dbc05 24 lcd.printf("%3d", dist);
SMART_CLEO 0:e7c4d23dbc05 25 wait(0.5);
SMART_CLEO 0:e7c4d23dbc05 26 }
SMART_CLEO 0:e7c4d23dbc05 27 }
SMART_CLEO 0:e7c4d23dbc05 28
SMART_CLEO 0:e7c4d23dbc05 29 float Ultrasonic_cm(void)
SMART_CLEO 0:e7c4d23dbc05 30 {
SMART_CLEO 0:e7c4d23dbc05 31 Ultrasonic.startMeasurement();
SMART_CLEO 0:e7c4d23dbc05 32
SMART_CLEO 0:e7c4d23dbc05 33 while(!Ultrasonic.isNewDataReady());
SMART_CLEO 0:e7c4d23dbc05 34
SMART_CLEO 0:e7c4d23dbc05 35 return Ultrasonic.getDistance_cm();
SMART_CLEO 0:e7c4d23dbc05 36 }