受信用
fep_kinect.cpp@0:dcb57ed979f0, 2018-10-12 (annotated)
- Committer:
- tanabe2000
- Date:
- Fri Oct 12 04:40:32 2018 +0000
- Revision:
- 0:dcb57ed979f0
kinect???
Who changed what in which revision?
User | Revision | Line number | New contents of line |
---|---|---|---|
tanabe2000 | 0:dcb57ed979f0 | 1 | #include"fep_kinect.h" |
tanabe2000 | 0:dcb57ed979f0 | 2 | |
tanabe2000 | 0:dcb57ed979f0 | 3 | fep_kinect::fep_kinect(PinName tx,PinName rx,uint8_t addr,int baud) : |
tanabe2000 | 0:dcb57ed979f0 | 4 | fep_(tx,rx,addr,baud) |
tanabe2000 | 0:dcb57ed979f0 | 5 | { |
tanabe2000 | 0:dcb57ed979f0 | 6 | fep_.startReceive(2); |
tanabe2000 | 0:dcb57ed979f0 | 7 | } |
tanabe2000 | 0:dcb57ed979f0 | 8 | |
tanabe2000 | 0:dcb57ed979f0 | 9 | |
tanabe2000 | 0:dcb57ed979f0 | 10 | uint16_t fep_kinect::get_distance() |
tanabe2000 | 0:dcb57ed979f0 | 11 | { |
tanabe2000 | 0:dcb57ed979f0 | 12 | return data_[0]; |
tanabe2000 | 0:dcb57ed979f0 | 13 | } |
tanabe2000 | 0:dcb57ed979f0 | 14 | |
tanabe2000 | 0:dcb57ed979f0 | 15 | uint16_t fep_kinect::get_mode() |
tanabe2000 | 0:dcb57ed979f0 | 16 | { |
tanabe2000 | 0:dcb57ed979f0 | 17 | return data_[1]; |
tanabe2000 | 0:dcb57ed979f0 | 18 | } |
tanabe2000 | 0:dcb57ed979f0 | 19 | void fep_kinect::newdata() |
tanabe2000 | 0:dcb57ed979f0 | 20 | { |
tanabe2000 | 0:dcb57ed979f0 | 21 | fep_.getData(data); |
tanabe2000 | 0:dcb57ed979f0 | 22 | data_[2] = (int(data[0]) << 8) | int(data[1]); |
tanabe2000 | 0:dcb57ed979f0 | 23 | data_[1] = data_[2] % 10; |
tanabe2000 | 0:dcb57ed979f0 | 24 | data_[0] = data_[2] / 10; |
tanabe2000 | 0:dcb57ed979f0 | 25 | } |