1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
|
#include <zmq.h>
#include <assert.h>
#include <libgen.h>
#include <unistd.h>
#include <sys/stat.h>
#include <signal.h>
#include "utils.h"
#ifndef LOGGERS_DELAY
#define LOGGERS_DELAY 0
#endif
// Global:
char *__client;
char __logdir[STATIC_LEN];
char __regpower[STATIC_LEN];
int __loginterval;
unsigned char __stop=0;
void sighandler(int signo){
if (signo == SIGINT){
printf("Stopping...\n");
__stop=1;
}
}
void publish(int queue_id);
typedef struct record {
time_t secs;
long nsecs;
uint16_t power;
} record;
typedef struct queue {
int length;
record records[RECORD_MAX];
} queue;
queue queues[RECORD_QUEUES];
int main (int argc, char *argv [])
{
if(argc != 4){
printf("Usage: %s <abslogdir> <client> <loginterval>",argv[0]);
exit(1);
}
//----- Init global variables
__client=argv[2];
__loginterval=atoi(argv[3]);
// __logdir:
strcat(__logdir,argv[1]);
strcat(__logdir,"/");
strcat(__logdir,__client);
// __regpower:
strcat(__regpower,INA260_SYSFS);
strcat(__regpower,"/");
strcat(__regpower,__client);
strcat(__regpower,"/");
strcat(__regpower,INA260_POWER_REGISTER);
//----- Sanity checks
signal(SIGINT,sighandler);
mkdirp(__logdir);
if(__loginterval<MIN_INTERVAL){
printf("Log interval is too small (min=%ds)\n",MIN_INTERVAL);
exit(2);
}
if(FILE_EXISTS(__regpower)){
printf("Logger cannot access to %s\n",__regpower);
exit(3);
}
//----- Start logging
printf("Logger started [client=%s,interval=%ds]\n",__client,__loginterval);
FILE *regptr,*logptr;
char logfilepath[STATIC_LEN]="";
regptr=fopen("/home/loic/out.txt","r");
char buffer[STATIC_LEN];
int power;
time_t interval;
struct timespec power_ts;
int queue_id=0;
while(!__stop){
interval=INTERVAL(__loginterval);
// Log current interval
queue_id=queue_id>=RECORD_QUEUES ? 0 : queue_id+1;
int record=0;
while((TIMESTAMP()-interval)<__loginterval){
if(__stop)
break;
if(record < RECORD_MAX){
// Read power:
fgets(buffer,STATIC_LEN,regptr);
// Get power measurement timestamp:
clock_gettime(CLOCK_REALTIME,&power_ts);
queues[queue_id].records[record].secs=power_ts.tv_sec;
queues[queue_id].records[record].nsecs=power_ts.tv_nsec;
queues[queue_id].records[record].power=atoi(buffer);
// Reset power register file:
fseek(regptr,0,SEEK_SET);
#if LOGGERS_DELAY > 0
usleep(LOGGERS_DELAY*1000);
#endif
printf("Tick\n"); fflush(stdout);
record++;
} else {
printf("Queue overflow, RECORD_MAX must be increase!! n=%d\n",record);
}
}
queues[queue_id].length=record;
publish(queue_id);
}
fclose(regptr);
return 0;
}
void publish(int queue_id){
for(int i=0;i<queues[queue_id].length;i++){
printf("%d,%ld,%d\n",queues[queue_id].records[i].secs,queues[queue_id].records[i].nsecs,queues[queue_id].records[i].power);
fflush(stdout);
}
}
|
