natsu tsumagari
/
test_cadenceClass
回転数計のクラスです。
Cadence.h
- Committer:
- tsumagari
- Date:
- 2016-11-23
- Revision:
- 0:57308daf8dfe
- Child:
- 1:6bceac3446ff
File content as of revision 0:57308daf8dfe:
#ifndef CADENCE_H #define CADENCE_H #include "mbed.h" #include <string> #define CADENCE_READ_TIME 0.1 //Serial cadenceTwe(p13,p14); Ticker cadenceReadTicker; class Cadence : public Serial{ private: static const int DATAS_NUM = 74; int data_count, data_num; char data[DATAS_NUM]; string strData; int gomi; protected: public: double cadence, cadenceV; Cadence(PinName tx, PinName rx, const char* name = NULL) : Serial(tx, rx, NULL){ for(int i=0;i<DATAS_NUM;i++) data[i]= NULL; data_num=0; data_count=0; baud(115200); cadence=0; cadenceV=0; } // void Init(){ // for(int i=0;i<DATAS_NUM;i++) data[i]= NULL; // data_num=0; // data_count=0; // baud(115200); // } void cadenceRead(){ //Ticker で定期的に呼び出して値を更新 do{ if(readable()) { data[data_count] = getc(); data_count++; } }while(data[--data_count] == '\r'); if(data_count > DATAS_NUM-4 ){ strData = data; } switch (strData.length()){ case DATAS_NUM-3 : strData.erase(0,1); break; case DATAS_NUM-2 : strData.erase(0,2); break; case DATAS_NUM-1 : strData.erase(0,3); break; case DATAS_NUM : strData.erase(0,4); } sscanf(strData.substr(27,4).c_str(),"%f",&cadenceV); sscanf(strData.substr(64,4).c_str(),"%f",&cadence); cadence /= 6.0; } }; #endif