NagaokaRoboticsClub_mbedTeam / Mbed OS kinect_fep_rx_sample

a_team_fep_rx_from_kinect_sample

Diff: fep_kinect/fep_kinect.cpp

Revision:
0:338b7241e445
--- /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