i_fread.cpp
4.23 KB
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
#include "blc_core.h"
#include "blc_channel.h"
#include "blc_program.h"
#include <unistd.h>
#include <termios.h>
#include <libgen.h> //basename
static int file_get_lines_number(FILE* file){
int ch, lines_nb;
lines_nb=0;
while(feof(file)==0){
ch = fgetc(file);
if (ch == '\n') lines_nb++;
else if ( ch == EOF ) if (feof(file)==0) EXIT_ON_SYSTEM_ERROR("Reading file");
}
return lines_nb;
}
static void array_def_with_tsv_file_first_line(blc_array *array, char const *filename, char const *time_str){
char const *ext;
FILE *file;
size_t linecap=0;
char *line=NULL;
int length;
char const *pos;
ext=blc_get_filename_extension(filename);
if (strcmp(ext, "tsv")!=0) EXIT_ON_ERROR("'%s' does not .tsv extension but '%s'", filename, ext);
SYSTEM_ERROR_CHECK(file=fopen(filename, "r"), NULL, "opening '%s'", filename);
SYSTEM_ERROR_CHECK(getline(&line, &linecap, file), -1, "Reading '%s'", filename);
pos=line;
length=0;
while(pos){
pos=strchr(pos+1, '\t');
if (pos) length++;
}
if (time_str) length--; //The first coulmn dos not count it is the time.
array->def_array('FL32', 'NDEF', 1, length);
fclose(file);
}
int main(int argc, char** argv){
char const *period_str, *text;
char const *channel_name, *filename, *time_str;
char const *number_str;
char *default_output;
int number, ret;
long executing_time, previous_executing_time;
size_t linecap=0;
ssize_t line_size;
blc_channel channel;
FILE *file;
int period;
asprintf(&default_output, "/%s%d", basename(argv[0]), getpid()); //This will not be free but it is only allocate once
blc_program_set_description("Update channel with a tsv file");
blc_program_add_option(&number_str, 'n', "number", "integer", "Number of records (-1 for infinity)", "-1");
blc_program_add_option(&channel_name, 'o', "output_channel", "string", "Name of the channel to output the data", default_output);
blc_program_add_option(&period_str, 'p', "period", "integer", "Period in ms to read line by line (default 0 i.e. as fast as possible)", NULL);
blc_program_add_option(&time_str, 't', "time", NULL, "use time in first column (in µs).", NULL);
blc_program_add_parameter(&filename, "filename", 1, "File to load", NULL);
blc_program_init(&argc, &argv, blc_quit);
blc_command_forward_blc_channels();
if (period_str){
if (time_str) EXIT_ON_ERROR("You can either use fix period or first column time but not both: period '%s' and time (-t) activated", period_str);
period=strtod(period_str, NULL)*1000;
} else period=0;
number=strtod(number_str, NULL);
array_def_with_tsv_file_first_line(&channel, filename, time_str);
channel.create_or_open(channel_name, BLC_CHANNEL_WRITE);
blc_loop_try_add_posting_semaphore(channel.sem_ack_data);
SYSTEM_ERROR_CHECK(file=fopen(filename, "r"), NULL, "Opening '%s'", filename);
if (time_str) SYSTEM_SUCCESS_CHECK(fscanf(file, "%ld\t", &previous_executing_time), 1, "Reading time in file '%s'", filename);
channel.publish();
BLC_COMMAND_LOOP(period){
if (number==blc_loop_iteration) blc_command_ask_quit();
else{
if (feof(file)){
if (number==-1) blc_command_ask_quit();
else EXIT_ON_ERROR("End of file and you request '%d' iterations. Only '%d' has been done.", number, blc_loop_iteration);
}
else{
fscan_tsv_floats(file, channel.floats, channel.dims[0].length);
if (time_str) {
ret=fscanf(file, "%lld\t", &executing_time);
if (ret==0 && feof(file)){
if (number==-1) blc_command_ask_quit();
else EXIT_ON_ERROR("End of file and you request '%d' iterations. Only '%d' has been done.", number, blc_loop_iteration);
}
blc_command_loop_period=executing_time-previous_executing_time; //We request the BLC_COMMAND_LOOP to last the time during two records. This overwrite period effect
previous_executing_time=executing_time;
}
}
}
}
SYSTEM_ERROR_CHECK(fclose(file), -1, "Closing '%s'", filename);
return EXIT_SUCCESS;
}