IOT_GRZYBKI / Mbed 2 deprecated client3

Code for sensor nodes connected by radio receiver with gateway

Dependencies:   mbed WakeUp coapRadioClient DHT11

distanceMeter.cpp

Committer:
Ka_myk
Date:
2019-01-25
Revision:
3:4ffffdb5230f
Child:
6:5102672e8ff4

File content as of revision 3:4ffffdb5230f:

#include "distanceMeter.h"
#include "mbed.h"

void DistanceMeter::echoUp() {
    timer.start();
}

void DistanceMeter::echoDown() {
    timer.stop();
    timeUs = timer.read_us();
    timer.reset();
    timeReady = true;
}

DistanceMeter::DistanceMeter(PinName echoPin, PinName triggerPin): timeReady(false), echo(echoPin), trigger(triggerPin) {
    trigger = 0;
}

void DistanceMeter::initialize() {
    echo.rise(&echoUp);
    echo.fall(&echoDown);
}

int DistanceMeter::read() {
    trigger = 1;
    wait_us(10);
    trigger = 0;

    while(!timeReady)
        wait_us(100);

    timeReady = false;
    return timeUs * 17 / 1000; // dist in cm, (time * 340) / (2 * 10000)

}

int DistanceMeter::getSensorId() {
    return 0;
}