Hyeonjong Lee / Ultrasonic

Ultrasonic

Dependents:   2014_Ensoul_Capstone Thrower_KRAI ECE4180Finalproject 4180Lab3Part2

Ultrasonic.cpp

Committer:
leejong87
Date:
2014-11-04
Revision:
1:d8a93321fc01
Parent:
0:4a3021604777

File content as of revision 1:d8a93321fc01:

#include "Ultrasonic.h"
#include "mbed.h"

Ultrasonic::Ultrasonic(PinName tx, PinName rx) : _tx(tx),_rx(rx)
{
    _tx.input();
    t.reset();
    triger.attach(this, &Ultrasonic::triger_func, 0.1);
    _rx.rise(this, &Ultrasonic::start_func);
    _rx.fall(this, &Ultrasonic::end_func);
}

void Ultrasonic::triger_func()
{
    _tx.output();
    _tx = 1;
    wait_us(5);
    _tx = 0;
    _tx.input();

}

void Ultrasonic::start_func()
{
    t.reset();
    t.start();
}

void Ultrasonic::end_func()
{
    t.stop();
    if (( t > 0.00012 ) & ( t < 0.0187)) {
        eco = 331.5*(t/2.0)*1000; // 30mm ~ 3000mm
    }
}

float Ultrasonic::read()
{
    return eco;
}