albatross / Mbed 2 deprecated keiki2017

2017年度の製作を開始します。

Dependencies:   BufferedSoftSerial2 SDFileSystem-RTOS mbed mbed-rtos INA226_ver1

Fork of keiki2016ver5 by albatross

Cadence.h@36:b4b9b67a770d, 2017-02-18 (annotated)

Committer:
tsumagari
Date:
Sat Feb 18 08:56:14 2017 +0000
Revision:
36:b4b9b67a770d
Parent:
35:4c02c7ff81ab 
Cadence.h?checkInt???????

Who changed what in which revision?

UserRevisionLine numberNew contents of line
tsumagari 36:b4b9b67a770d 1 //;2648 ;00 00000 0;168 ;001; 10043 c1;31 10;00 00;00 00;10 63;08 39;I; -012; 0002; 0104;\r\n
tsumagari 36:b4b9b67a770d 2 //;109 ;00 00000 0;123 ;011; 10008 e4;27 95;00 00;00 00;13 99;08 51;G; -068; -096; -192;
tsumagari 15:6966299bea4c 3 #ifndef CADENCE_H
tsumagari 15:6966299bea4c 4 #define CADENCE_H
tsumagari 15:6966299bea4c 5
tsumagari 15:6966299bea4c 6 #include "mbed.h"
tsumagari 15:6966299bea4c 7 #include <string>
tsumagari 36:b4b9b67a770d 8 DigitalOut led3(LED3);
tsumagari 21:8802034b7810 9 class Cadence : public RawSerial{
tsumagari 15:6966299bea4c 10 private:
tsumagari 15:6966299bea4c 11 static const int DATAS_NUM = 75;
tsumagari 15:6966299bea4c 12
tsumagari 15:6966299bea4c 13 protected:
tsumagari 15:6966299bea4c 14
tsumagari 15:6966299bea4c 15 public:
tsumagari 15:6966299bea4c 16 string strC,strV;
tsumagari 15:6966299bea4c 17 char data[DATAS_NUM];
tsumagari 15:6966299bea4c 18 string strData;
tsumagari 15:6966299bea4c 19 int data_count, data_num;
tsumagari 15:6966299bea4c 20 double cadence, voltage;
tsumagari 21:8802034b7810 21 Cadence(PinName tx, PinName rx, const char* name = NULL) : RawSerial(tx, rx){
tsumagari 15:6966299bea4c 22 for(int i=0;i<DATAS_NUM;i++) data[i]= NULL;
tsumagari 15:6966299bea4c 23 data_num=0;
tsumagari 15:6966299bea4c 24 data_count=0;
tsumagari 15:6966299bea4c 25 baud(115200);
tsumagari 15:6966299bea4c 26 cadence=0;
tsumagari 15:6966299bea4c 27 voltage=0;
tsumagari 15:6966299bea4c 28 }
tsumagari 36:b4b9b67a770d 29 int checkInt(const char c[]){
tsumagari 36:b4b9b67a770d 30 for(int i = 0; i<strlen(c); i++){
tsumagari 36:b4b9b67a770d 31 if( c[0] == '-' ) continue;
tsumagari 35:4c02c7ff81ab 32 if( c[i] - '0' > 9 || c[i] - '0' <0 ) return -1;
tsumagari 35:4c02c7ff81ab 33 }return 1;
tsumagari 35:4c02c7ff81ab 34 }
tsumagari 29:2da9b8d03c0b 35 void readData(){
tsumagari 26:50272431cd1e 36 if(readable()){
tsumagari 15:6966299bea4c 37 data_count = 0;
tsumagari 36:b4b9b67a770d 38 for (int i = 0; i<DATAS_NUM; i++) data[i] = NULL;
tsumagari 15:6966299bea4c 39 do{
tsumagari 15:6966299bea4c 40 if(readable()) {
tsumagari 15:6966299bea4c 41 data[data_count] = getc();
tsumagari 36:b4b9b67a770d 42 if(data[data_count] != '\n') data_count++;
tsumagari 15:6966299bea4c 43 }
tsumagari 36:b4b9b67a770d 44 }while(data[data_count] != '\n' && data_count<DATAS_NUM);
tsumagari 15:6966299bea4c 45 strData = data;
tsumagari 26:50272431cd1e 46 if( int strlength = strData.length() > DATAS_NUM-4 ){
tsumagari 26:50272431cd1e 47 // for(int i = 0; i<4; i++){
tsumagari 26:50272431cd1e 48 // strC += data[data_count-6+i];
tsumagari 26:50272431cd1e 49 // strV += data[data_count-43+i];
tsumagari 26:50272431cd1e 50 // }
tsumagari 36:b4b9b67a770d 51 // if( checkInt(strC) ) sscanf(strC,"%lf",&cadence);
tsumagari 36:b4b9b67a770d 52 // if( checkInt(strV) ) sscanf(strV,"%lf",&voltage);
tsumagari 36:b4b9b67a770d 53
tsumagari 15:6966299bea4c 54 switch (strData.length()){
tsumagari 15:6966299bea4c 55 case DATAS_NUM-3 :
tsumagari 15:6966299bea4c 56 strData.erase(0,2);
tsumagari 15:6966299bea4c 57 break;
tsumagari 15:6966299bea4c 58 case DATAS_NUM-2 :
tsumagari 15:6966299bea4c 59 strData.erase(0,3);
tsumagari 15:6966299bea4c 60 break;
tsumagari 15:6966299bea4c 61 case DATAS_NUM-1 :
tsumagari 15:6966299bea4c 62 strData.erase(0,4);
tsumagari 15:6966299bea4c 63 break;
tsumagari 15:6966299bea4c 64 case DATAS_NUM :
tsumagari 15:6966299bea4c 65 strData.erase(0,5);
tsumagari 15:6966299bea4c 66 }
tsumagari 36:b4b9b67a770d 67 strV = strData.substr(27,4);
tsumagari 15:6966299bea4c 68 strC = strData.substr(64,4);
tsumagari 35:4c02c7ff81ab 69 if( checkInt( strV.c_str() ) ) sscanf(strV.c_str(),"%lf",&voltage);
tsumagari 35:4c02c7ff81ab 70 if( checkInt( strC.c_str() ) ) sscanf(strC.c_str(),"%lf",&cadence);
tsumagari 36:b4b9b67a770d 71
tsumagari 26:50272431cd1e 72 cadence /= 6.0;
tsumagari 26:50272431cd1e 73 voltage *= 0.001;
tsumagari 15:6966299bea4c 74 }
tsumagari 26:50272431cd1e 75 }
tsumagari 15:6966299bea4c 76 }
tsumagari 15:6966299bea4c 77 };
tsumagari 15:6966299bea4c 78 #endif