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?
User | Revision | Line number | New 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 |