![](/media/cache/group/default_image.jpg.50x50_q85.jpg)
a_team_fep_rx_from_kinect_sample
Diff: fep_kinect/fep_kinect.cpp
- Revision:
- 0:338b7241e445
diff -r 000000000000 -r 338b7241e445 fep_kinect/fep_kinect.cpp --- /dev/null Thu Jan 01 00:00:00 1970 +0000 +++ b/fep_kinect/fep_kinect.cpp Thu Oct 04 10:54:05 2018 +0000 @@ -0,0 +1,25 @@ +#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; +} \ No newline at end of file