Raspberry Pi Camera
QQQCAM.cpp@1:546f9ce8f4c0, 2020-09-19 (annotated)
- Committer:
- tanahashi
- Date:
- Sat Sep 19 10:05:44 2020 +0000
- Revision:
- 1:546f9ce8f4c0
- Parent:
- 0:7a6b30b678c7
add comment
Who changed what in which revision?
User | Revision | Line number | New contents of line |
---|---|---|---|
tanahashi | 0:7a6b30b678c7 | 1 | #include "mbed.h" |
tanahashi | 0:7a6b30b678c7 | 2 | #include "QQQCAM.h" |
tanahashi | 0:7a6b30b678c7 | 3 | |
tanahashi | 0:7a6b30b678c7 | 4 | QQQCAM::QQQCAM(Serial &cam_serial) |
tanahashi | 0:7a6b30b678c7 | 5 | { |
tanahashi | 0:7a6b30b678c7 | 6 | _serial = &cam_serial; |
tanahashi | 0:7a6b30b678c7 | 7 | _serial->attach(callback(this, &QQQCAM::receive), Serial::RxIrq); |
tanahashi | 0:7a6b30b678c7 | 8 | } |
tanahashi | 0:7a6b30b678c7 | 9 | |
tanahashi | 0:7a6b30b678c7 | 10 | void QQQCAM::receive() |
tanahashi | 0:7a6b30b678c7 | 11 | { |
tanahashi | 0:7a6b30b678c7 | 12 | char c = _serial->getc(); |
tanahashi | 0:7a6b30b678c7 | 13 | if(c == '$') { |
tanahashi | 0:7a6b30b678c7 | 14 | index = 0; |
tanahashi | 0:7a6b30b678c7 | 15 | flag = 1; |
tanahashi | 0:7a6b30b678c7 | 16 | } |
tanahashi | 0:7a6b30b678c7 | 17 | if(flag == 1) { |
tanahashi | 0:7a6b30b678c7 | 18 | rx_buf[index] = c; |
tanahashi | 0:7a6b30b678c7 | 19 | if(c == '\n') { |
tanahashi | 0:7a6b30b678c7 | 20 | rx_buf[index + 1] = '\0'; |
tanahashi | 0:7a6b30b678c7 | 21 | flag = 2; |
tanahashi | 0:7a6b30b678c7 | 22 | } else { |
tanahashi | 0:7a6b30b678c7 | 23 | index++; |
tanahashi | 0:7a6b30b678c7 | 24 | } |
tanahashi | 0:7a6b30b678c7 | 25 | } |
tanahashi | 0:7a6b30b678c7 | 26 | if(flag == 2) { |
tanahashi | 0:7a6b30b678c7 | 27 | sscanf(rx_buf, "$CAM,%f", &rate); |
tanahashi | 0:7a6b30b678c7 | 28 | flag = 0; |
tanahashi | 0:7a6b30b678c7 | 29 | } |
tanahashi | 0:7a6b30b678c7 | 30 | } |
tanahashi | 0:7a6b30b678c7 | 31 | |
tanahashi | 0:7a6b30b678c7 | 32 | float QQQCAM::get_rate(){ |
tanahashi | 0:7a6b30b678c7 | 33 | return rate; |
tanahashi | 0:7a6b30b678c7 | 34 | } |