![](/media/cache/group/default_image.jpg.50x50_q85.jpg)
a_team_fep_rx_from_kinect_sample
fep_kinect/fep_kinect.cpp@0:338b7241e445, 2018-10-04 (annotated)
- Committer:
- skouki
- Date:
- Thu Oct 04 10:54:05 2018 +0000
- Revision:
- 0:338b7241e445
v1;
Who changed what in which revision?
User | Revision | Line number | New contents of line |
---|---|---|---|
skouki | 0:338b7241e445 | 1 | #include"fep_kinect.h" |
skouki | 0:338b7241e445 | 2 | |
skouki | 0:338b7241e445 | 3 | fep_kinect::fep_kinect(PinName tx,PinName rx,uint8_t addr,int baud) : |
skouki | 0:338b7241e445 | 4 | fep_(tx,rx,addr,baud) |
skouki | 0:338b7241e445 | 5 | { |
skouki | 0:338b7241e445 | 6 | fep_.startReceive(2); |
skouki | 0:338b7241e445 | 7 | } |
skouki | 0:338b7241e445 | 8 | |
skouki | 0:338b7241e445 | 9 | |
skouki | 0:338b7241e445 | 10 | uint16_t fep_kinect::get_distance() |
skouki | 0:338b7241e445 | 11 | { |
skouki | 0:338b7241e445 | 12 | return data_[0]; |
skouki | 0:338b7241e445 | 13 | } |
skouki | 0:338b7241e445 | 14 | |
skouki | 0:338b7241e445 | 15 | uint16_t fep_kinect::get_mode() |
skouki | 0:338b7241e445 | 16 | { |
skouki | 0:338b7241e445 | 17 | return data_[1]; |
skouki | 0:338b7241e445 | 18 | } |
skouki | 0:338b7241e445 | 19 | void fep_kinect::newdata() |
skouki | 0:338b7241e445 | 20 | { |
skouki | 0:338b7241e445 | 21 | fep_.getData(data); |
skouki | 0:338b7241e445 | 22 | data_[2] = (int(data[0]) << 8) | int(data[1]); |
skouki | 0:338b7241e445 | 23 | data_[1] = data_[2] % 10; |
skouki | 0:338b7241e445 | 24 | data_[0] = data_[2] / 10; |
skouki | 0:338b7241e445 | 25 | } |