Mercurial > hg > beaglert

annotate projects/d-box/logger.cpp @ 151:e9c9404e3d1f ClockSync

Find changesets by keywords (author, files, the commit message), revision number or hash, or revset expression.
Pff partially working. No PID. When setting the audio clock on the bbb to 44098 the master and slave clock keep diverging instead of converging ...
author Giulio Moro <giuliomoro@yahoo.it>
date Tue, 22 Sep 2015 04:10:07 +0100
parents 8a575ba3ab52
children 18d03901f866
rev   line source
andrewm@0 1 /*
andrewm@0 2 * logger.cpp
andrewm@0 3 *
andrewm@0 4 * Created on: Aug 6, 2014
andrewm@0 5 * Author: VIctor Zappi and Andrew McPherson
andrewm@0 6 */
andrewm@0 7
andrewm@0 8 #include "logger.h"
andrewm@0 9
andrewm@0 10 // main extern vars
andrewm@0 11 extern bool gShouldStop;
andrewm@0 12 extern int gVerbose;
andrewm@0 13
andrewm@0 14 // file nanme extern vars
andrewm@0 15 extern char gId;
andrewm@0 16 extern char gGroup;
andrewm@0 17
andrewm@0 18
andrewm@0 19 // logged extern vars
andrewm@0 20 extern int s0TouchNum;
andrewm@0 21 extern float s0Touches_[MAX_TOUCHES];
andrewm@0 22 extern float s0Size_[MAX_TOUCHES];
andrewm@0 23 extern int s0LastIndex;
andrewm@0 24
andrewm@0 25 extern int s1TouchNum;
andrewm@0 26 extern float s1Touches_[MAX_TOUCHES];
andrewm@0 27 extern float s1Size_[MAX_TOUCHES];
andrewm@0 28 extern int s1LastIndex;
andrewm@0 29
andrewm@0 30 extern int fsr;
andrewm@0 31
andrewm@0 32
andrewm@0 33
andrewm@0 34 string logPath = "/boot/uboot/instrumentLog";
andrewm@0 35 string logFileIncipit = "/datalog";
andrewm@0 36 string logFileName = "";
andrewm@0 37 ofstream logFile;
andrewm@0 38 timeval logTimeVal;
andrewm@0 39 unsigned long long logTimeOrig;
andrewm@0 40 int logCnt = 0; // counts how many lines so far
andrewm@0 41 int logCntSwap = 50; // how many log lines before closing and re-opening the file
andrewm@0 42
andrewm@0 43
andrewm@0 44 // create the log file, using incremental name convention
andrewm@0 45 int initLogLoop()
andrewm@0 46 {
andrewm@0 47 if(gVerbose==1)
andrewm@0 48 cout << "---------------->Init Log Thread" << endl;
andrewm@0 49
andrewm@0 50
andrewm@0 51 // transform chars into strings via stringstream objs
andrewm@0 52 stringstream id_ss, group_ss, freedom_ss;
andrewm@0 53 id_ss << gId;
andrewm@0 54 group_ss << gGroup;
andrewm@0 55
andrewm@0 56 int logNum = -1;
andrewm@0 57 int logMax = -1;
andrewm@0 58 int pathLen = logPath.length() + logFileIncipit.length() + 4; // + 4 is: "_", id, group, "_"
andrewm@0 59 glob_t globbuf;
andrewm@0 60
andrewm@0 61 // check how many log files are already there, and choose name according to this
andrewm@0 62 glob( (logPath + logFileIncipit + "*").c_str(), 0, NULL, &globbuf);
andrewm@0 63
andrewm@0 64 // cycle through all and find the highest index
andrewm@0 65 for(unsigned int i=0; i<globbuf.gl_pathc; i++)
andrewm@0 66 {
andrewm@0 67 // playing with 0-9 char digits, forming a number from 0 to 9999
andrewm@0 68 logNum = (globbuf.gl_pathv[i][pathLen]-48) * 1000; // 42 to 45 are the indices of the chars forming the file index
andrewm@0 69 logNum += (globbuf.gl_pathv[i][pathLen+1]-48) * 100;
andrewm@0 70 logNum += (globbuf.gl_pathv[i][pathLen+2]-48) * 10;
andrewm@0 71 logNum += globbuf.gl_pathv[i][pathLen+3]-48;
andrewm@0 72 if(logNum > logMax)
andrewm@0 73 logMax = logNum;
andrewm@0 74 }
andrewm@0 75 logNum = logMax + 1; // new index
andrewm@0 76
andrewm@0 77 globfree(&globbuf);
andrewm@0 78
andrewm@0 79 ostringstream numString;
andrewm@0 80 numString << setw (4) << setfill ('0') << logNum; // set integer with 4 figures
andrewm@0 81
andrewm@0 82 // here are the new names: PATH + DIR + INCIPIT + _ + id + group + freedom + _ + NUM (4figures) + _A.txt
andrewm@0 83 logFileName = logPath + logFileIncipit;
andrewm@0 84 logFileName += "_" + id_ss.str() + group_ss.str() + freedom_ss.str();
andrewm@0 85 logFileName += "_" + numString.str(); //static_cast<ostringstream*>( &(ostringstream() << logNum) )->str();
andrewm@0 86 logFileName += ".txt";
andrewm@0 87
andrewm@0 88
andrewm@0 89 // create new files
andrewm@0 90 FILE *fp_a = fopen(logFileName.c_str(), "wb");
andrewm@0 91 if(!fp_a)
andrewm@0 92 {
andrewm@0 93 dbox_printf("Cannot create files...\n");
andrewm@0 94 return 2;
andrewm@0 95 }
andrewm@0 96 fclose(fp_a);
andrewm@0 97
andrewm@0 98 // ready to append
andrewm@0 99 logFile.open(logFileName.c_str(), ios::out | ios::app);
andrewm@0 100
andrewm@0 101 dbox_printf("Logging on file %s\n", logFileName.c_str());
andrewm@0 102
andrewm@0 103 return 0;
andrewm@0 104 }
andrewm@0 105
andrewm@0 106
andrewm@0 107 void writeData(unsigned long long time)
andrewm@0 108 {
andrewm@0 109
andrewm@0 110 float fsr_ = ((float)(1799-fsr)/1799.0);
andrewm@0 111 logFile << time << "\t" // timestamp
andrewm@0 112 << s0TouchNum << "\t"; // sensor 0 touch count
andrewm@0 113 for(int i=0; i<MAX_TOUCHES; i++)
andrewm@0 114 logFile << s0Touches_[i] << "\t"; // sensor 0 touch pos x
andrewm@0 115 for(int i=0; i<MAX_TOUCHES; i++)
andrewm@0 116 logFile << s0Size_[i] << "\t"; // sensor 0 touch size
andrewm@0 117 logFile << s0LastIndex << "\t" // sensor 0 last index
andrewm@0 118 << fsr_ << "\t" // sensor 0 FSR pressure
andrewm@0 119 << s1TouchNum << "\t"; // sensor 1 touch count
andrewm@0 120 for(int i=0; i<MAX_TOUCHES; i++)
andrewm@0 121 logFile << s1Touches_[i] << "\t"; // sensor 1 touch pos x
andrewm@0 122 for(int i=0; i<MAX_TOUCHES; i++)
andrewm@0 123 logFile << s1Size_[i] << "\t"; // sensor 1 touch size
andrewm@0 124 logFile << s1LastIndex << "\t" // sensor 1 last index
andrewm@0 125 //... AND SO ON
andrewm@0 126 << "\n";
andrewm@0 127
andrewm@0 128 //dbox_printf("%d\n", s0LastIndex);
andrewm@0 129 //dbox_printf("s0TouchNum: %d\t s0Touches[0]: %f\t s0Size[0]: %f\t s0LastIndex: %d\n", s0TouchNum, s0Touches_[0], s0Size_[0], s0LastIndex);
andrewm@0 130
andrewm@0 131 }
andrewm@0 132
andrewm@0 133 void logData(unsigned long long time)
andrewm@0 134 {
andrewm@0 135 // if it's time to change write-file
andrewm@0 136 if(logCnt >= logCntSwap)
andrewm@0 137 {
andrewm@0 138 logFile.close(); // close file, dump stream
andrewm@0 139 logCnt = 0; // ready for another whole round
andrewm@0 140
andrewm@0 141 // open again, ready to append
andrewm@0 142 logFile.open(logFileName.c_str(), ios::out | ios::app);
andrewm@0 143 }
andrewm@0 144
andrewm@0 145 writeData(time);
andrewm@0 146
andrewm@0 147 logCnt++;
andrewm@0 148 }
andrewm@0 149
andrewm@0 150
andrewm@0 151
andrewm@0 152
andrewm@0 153 void *logLoop(void *)
andrewm@0 154 {
andrewm@0 155 set_realtime_priority(10);
andrewm@0 156
andrewm@0 157 if(gVerbose==1)
andrewm@0 158 dbox_printf("_________________Log Thread!\n");
andrewm@0 159
andrewm@0 160 // get time reference
andrewm@0 161 gettimeofday(&logTimeVal, NULL);
andrewm@0 162 logData(0);
andrewm@0 163
andrewm@0 164 logTimeOrig = logTimeVal.tv_usec;
andrewm@0 165 logTimeOrig *= 0.001; // from usec to msec
andrewm@0 166 logTimeOrig += logTimeVal.tv_sec*1000; // from sec to msec
andrewm@0 167
andrewm@0 168 usleep(5000);
andrewm@0 169
andrewm@0 170 while(!gShouldStop)
andrewm@0 171 {
andrewm@0 172 gettimeofday(&logTimeVal, NULL);
andrewm@0 173 unsigned long long currentTime = logTimeVal.tv_usec;
andrewm@0 174 currentTime *= 0.001; // from usec to msec
andrewm@0 175 currentTime += logTimeVal.tv_sec*1000; // from sec to msec
andrewm@0 176
andrewm@0 177 logData(currentTime-logTimeOrig);
andrewm@0 178
andrewm@0 179 usleep(5000);
andrewm@0 180 }
andrewm@0 181
andrewm@0 182 if(logFile!=NULL)
andrewm@0 183 logFile.close();
andrewm@0 184
andrewm@0 185 dbox_printf("log thread ended\n");
andrewm@0 186
andrewm@0 187 return (void *)0;
andrewm@0 188 }