NagaokaRoboticsClub_mbedTeam / Mbed OS kinect_fep_rx_sample

a_team_fep_rx_from_kinect_sample

fep_kinect/fep_kinect.cpp

Committer:
skouki
Date:
2018-10-04
Revision:
0:338b7241e445

File content as of revision 0:338b7241e445:

#include"fep_kinect.h"

fep_kinect::fep_kinect(PinName tx,PinName rx,uint8_t addr,int baud) :
    fep_(tx,rx,addr,baud)
{
    fep_.startReceive(2);
}


uint16_t fep_kinect::get_distance()
{
    return data_[0];
}

uint16_t fep_kinect::get_mode()
{
    return data_[1];
}
void fep_kinect::newdata()
{
    fep_.getData(data);
    data_[2] = (int(data[0]) << 8) | int(data[1]);
    data_[1] = data_[2] % 10;
    data_[0] = data_[2] / 10;
}