QQQ / QQQCAM

Raspberry Pi Camera

Dependents:   qqq_izu_main_test

QQQCAM.cpp@0:7a6b30b678c7, 2020-09-19 (annotated)

Committer:
tanahashi
Date:
Sat Sep 19 09:58:31 2020 +0000
Revision:
0:7a6b30b678c7
first commit

Who changed what in which revision?

UserRevisionLine numberNew 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 }