SkyTEM BMAG / Mbed 2 deprecated BMAGThrRev

Bmag incl gps rettelse

Dependencies:   mbed WDT MODSERIAL BME280

BMAG/BMAG.cpp@8:d6287c33b54a, 2017-03-23 (annotated)

Committer:
MAA
Date:
Thu Mar 23 10:11:26 2017 +0000
Revision:
8:d6287c33b54a
Child:
14:400ecb93c6a2
BMAG klasse fungerende med dataopsamling fra BMAG.;

Who changed what in which revision?

UserRevisionLine numberNew contents of line
MAA 8:d6287c33b54a 1 #include "BMAG.h"
MAA 8:d6287c33b54a 2
MAA 8:d6287c33b54a 3 BMAG::BMAG(){
MAA 8:d6287c33b54a 4 lastMagTime.resize(25);
MAA 8:d6287c33b54a 5 lastMagNT.resize(25);
MAA 8:d6287c33b54a 6 lastMagSq.resize(25);
MAA 8:d6287c33b54a 7
MAA 8:d6287c33b54a 8 };
MAA 8:d6287c33b54a 9
MAA 8:d6287c33b54a 10 void BMAG::parseBMAGString(string str){
MAA 8:d6287c33b54a 11 string tmpmagStr = "";
MAA 8:d6287c33b54a 12
MAA 8:d6287c33b54a 13 //get first mag string column
MAA 8:d6287c33b54a 14 tmpmagStr.assign(getColumn(str, 0));
MAA 8:d6287c33b54a 15
MAA 8:d6287c33b54a 16
MAA 8:d6287c33b54a 17 setMagTimeStr(tmpmagStr);
MAA 8:d6287c33b54a 18 tmpmagStr = "";
MAA 8:d6287c33b54a 19
MAA 8:d6287c33b54a 20 //get second mag string column
MAA 8:d6287c33b54a 21 tmpmagStr.assign(getColumn(str, 1));
MAA 8:d6287c33b54a 22 setMagNTStr(tmpmagStr);
MAA 8:d6287c33b54a 23
MAA 8:d6287c33b54a 24 tmpmagStr = "";
MAA 8:d6287c33b54a 25
MAA 8:d6287c33b54a 26 //get third mag string column
MAA 8:d6287c33b54a 27 tmpmagStr.assign(getColumn(str, 2));
MAA 8:d6287c33b54a 28
MAA 8:d6287c33b54a 29 setMagSqStr(tmpmagStr);
MAA 8:d6287c33b54a 30
MAA 8:d6287c33b54a 31
MAA 8:d6287c33b54a 32 };
MAA 8:d6287c33b54a 33
MAA 8:d6287c33b54a 34 void BMAG::setMagTimeStr(string magT){
MAA 8:d6287c33b54a 35 lastMagTime.assign(magT);
MAA 8:d6287c33b54a 36 };
MAA 8:d6287c33b54a 37
MAA 8:d6287c33b54a 38
MAA 8:d6287c33b54a 39 void BMAG::setMagNTStr(string magNT){
MAA 8:d6287c33b54a 40 lastMagNT.assign(magNT);
MAA 8:d6287c33b54a 41 };
MAA 8:d6287c33b54a 42
MAA 8:d6287c33b54a 43
MAA 8:d6287c33b54a 44 void BMAG::setMagSqStr(string magSq){
MAA 8:d6287c33b54a 45 lastMagSq.assign(magSq);
MAA 8:d6287c33b54a 46 };
MAA 8:d6287c33b54a 47
MAA 8:d6287c33b54a 48
MAA 8:d6287c33b54a 49 string BMAG::getMagTimeStr(void){
MAA 8:d6287c33b54a 50 return lastMagTime;
MAA 8:d6287c33b54a 51 };
MAA 8:d6287c33b54a 52
MAA 8:d6287c33b54a 53 string BMAG::getMagNTStr(void){
MAA 8:d6287c33b54a 54 return lastMagNT;
MAA 8:d6287c33b54a 55 };
MAA 8:d6287c33b54a 56
MAA 8:d6287c33b54a 57 string BMAG::getMagSq(void){
MAA 8:d6287c33b54a 58 return lastMagSq;
MAA 8:d6287c33b54a 59 };
MAA 8:d6287c33b54a 60
MAA 8:d6287c33b54a 61 string BMAG::getColumn(string str, char n){
MAA 8:d6287c33b54a 62
MAA 8:d6287c33b54a 63 char count = 0;
MAA 8:d6287c33b54a 64 string tmpStr = "";
MAA 8:d6287c33b54a 65 tmpStr.resize(40);
MAA 8:d6287c33b54a 66 char indexcnt = 0;
MAA 8:d6287c33b54a 67
MAA 8:d6287c33b54a 68
MAA 8:d6287c33b54a 69 for(int i = 0; i < str.size(); i++){
MAA 8:d6287c33b54a 70 if(count == n && (str[i] != '\r') || count == n && (str[i] != '\n')){
MAA 8:d6287c33b54a 71 tmpStr[indexcnt] = str[i];
MAA 8:d6287c33b54a 72 indexcnt += 1;
MAA 8:d6287c33b54a 73 }
MAA 8:d6287c33b54a 74
MAA 8:d6287c33b54a 75 if(str[i] == '\r' || str[i] == ' '){
MAA 8:d6287c33b54a 76 count += 1;
MAA 8:d6287c33b54a 77 }
MAA 8:d6287c33b54a 78
MAA 8:d6287c33b54a 79 if(count > n){
MAA 8:d6287c33b54a 80 break;
MAA 8:d6287c33b54a 81 }
MAA 8:d6287c33b54a 82 }
MAA 8:d6287c33b54a 83
MAA 8:d6287c33b54a 84 return tmpStr;
MAA 8:d6287c33b54a 85
MAA 8:d6287c33b54a 86 };
MAA 8:d6287c33b54a 87
MAA 8:d6287c33b54a 88
MAA 8:d6287c33b54a 89