File content as of revision 4:7622beb45675:

#include "TFmini.h"

TFmini::TFmini(PinName serialTX, PinName serialRX) :
    RawSerial(serialTX, serialRX, TF_DEFAULT_BAUD)
{
    attach(callback(this, &TFmini::receiveByte));
    thread.start(callback(this, &TFmini::assembleLoop));
}

void TFmini::receiveByte()
{
    buf.push_back(getc());
}

void TFmini::assemble()
{
    distance = ((buf[3]<<8)|buf[2]);    
    strength = ((buf[5]<<8)|buf[4]);
}

void TFmini::assembleLoop()
{
    while(true) {
        if(buf.size() > TF_SERIAL_BUFFER_SIZE) {
            if(buf[0] == TF_HEADER_FIRST_BYTE && buf[1] == TF_HEADER_SECOND_BYTE) {
                assemble();
                buf.erase(buf.begin(), buf.begin() + (TF_SERIAL_BUFFER_SIZE - 1));
            } else {
                buf.erase(buf.begin());
            }
        }
    }
}

int TFmini::getDistance()
{
    return distance;
}

int TFmini::getStrength()
{
    return strength;
}