nmxptool.c 24.8 KB
Newer Older
Matteo Quintiliani's avatar
Matteo Quintiliani committed
1
2
3
4
5
6
7
8
9
/*! \file
 *
 * \brief Nanometrics Protocol Tool
 *
 * Author:
 * 	Matteo Quintiliani
 * 	Istituto Nazionale di Geofisica e Vulcanologia - Italy
 *	quintiliani@ingv.it
 *
10
 * $Id: nmxptool.c,v 1.87 2007-11-21 13:12:49 mtheo Exp $
Matteo Quintiliani's avatar
Matteo Quintiliani committed
11
 *
Matteo Quintiliani's avatar
Matteo Quintiliani committed
12
13
 */

14
15
16
#include <stdio.h>
#include <stdlib.h>
#include <string.h>
Matteo Quintiliani's avatar
Matteo Quintiliani committed
17
#include <errno.h>
18
19

#include <nmxp.h>
Matteo Quintiliani's avatar
Matteo Quintiliani committed
20
21
22
23
24

#ifndef WIN32
#include <signal.h>
#endif

25
#include "config.h"
26
#include "nmxptool_getoptlong.h"
27
28

#ifdef HAVE_EARTHWORMOBJS
29
#include "nmxptool_ew.h"
30
#endif
31

32
33
34
#ifdef HAVE_LIBMSEED
#include <libmseed.h>
#endif
35

36
37
#ifdef HAVE___SRC_SEEDLINK_PLUGIN_H
#include "seedlink_plugin.h"
38
39
#endif

40
41
42
#define CURRENT_NETWORK ( (params.network)? params.network : DEFAULT_NETWORK )
#define NETCODE_OR_CURRENT_NETWORK ( (network_code[0] != 0)? network_code : CURRENT_NETWORK )

Matteo Quintiliani's avatar
Matteo Quintiliani committed
43
#define GAP_TOLLERANCE 0.001
44

45
46
47
typedef struct {
    int significant;
    double last_time;
Matteo Quintiliani's avatar
Matteo Quintiliani committed
48
    time_t last_time_call_raw_stream;
49
    int32_t x_1;
50
    NMXP_RAW_STREAM_DATA raw_stream_buffer;
51
52
} NMXPTOOL_CHAN_SEQ;

Matteo Quintiliani's avatar
Matteo Quintiliani committed
53
54
55
static void clientShutdown(int sig);
static void clientDummyHandler(int sig);

Matteo Quintiliani's avatar
Matteo Quintiliani committed
56
57
static void flushing_raw_data_stream();

58
#ifdef HAVE_LIBMSEED
Matteo Quintiliani's avatar
Matteo Quintiliani committed
59
int nmxptool_write_miniseed(NMXP_DATA_PROCESS *pd);
60
61
#endif

Matteo Quintiliani's avatar
Matteo Quintiliani committed
62
#ifdef HAVE___SRC_SEEDLINK_PLUGIN_C
Matteo Quintiliani's avatar
Matteo Quintiliani committed
63
int nmxptool_send_raw_depoch(NMXP_DATA_PROCESS *pd);
Matteo Quintiliani's avatar
Matteo Quintiliani committed
64
65
#endif

66
int nmxptool_print_seq_no(NMXP_DATA_PROCESS *pd);
Matteo Quintiliani's avatar
Matteo Quintiliani committed
67
68

int nmxptool_check_and_log_gap(double time1, double time2, const double gap_tollerance, const char *station, const char *channel);
Matteo Quintiliani's avatar
Matteo Quintiliani committed
69
void nmxptool_str_time_to_filename(char *str_time);
Matteo Quintiliani's avatar
Matteo Quintiliani committed
70
71


72
73
74
75
76
/* Global variable for main program and handling terminitation program */
NMXPTOOL_PARAMS params;
int naqssock = 0;
FILE *outfile = NULL;
NMXP_CHAN_LIST *channelList = NULL;
77
NMXP_CHAN_LIST_NET *channelList_subset = NULL;
78
NMXPTOOL_CHAN_SEQ *channelListSeq = NULL;
Matteo Quintiliani's avatar
Matteo Quintiliani committed
79
80
81
int n_func_pd = 0;
int (*p_func_pd[NMXP_MAX_FUNC_PD]) (NMXP_DATA_PROCESS *);

82
83
84
85
86
87
88
89

#ifdef HAVE_LIBMSEED
/* Mini-SEED variables */
NMXP_DATA_SEED data_seed;
MSRecord *msr_list_chan[MAX_N_CHAN];
#endif


90
int main (int argc, char **argv) {
91
    int32_t connection_time;
92
    int request_SOCKET_OK;
Matteo Quintiliani's avatar
Matteo Quintiliani committed
93
    int i_chan, cur_chan = 0;
Matteo Quintiliani's avatar
Matteo Quintiliani committed
94
    int to_cur_chan = 0;
Matteo Quintiliani's avatar
Matteo Quintiliani committed
95
    int exitpdscondition;
Matteo Quintiliani's avatar
Matteo Quintiliani committed
96
    int exitdapcondition;
Matteo Quintiliani's avatar
Matteo Quintiliani committed
97
    time_t timeout_for_channel;
Matteo Quintiliani's avatar
Matteo Quintiliani committed
98

Matteo Quintiliani's avatar
Matteo Quintiliani committed
99
    int span_interval = 10;
Matteo Quintiliani's avatar
Matteo Quintiliani committed
100
101
    int time_to_sleep = 0;

102
103
    char str_start_time[200];
    char str_end_time[200];
Matteo Quintiliani's avatar
Matteo Quintiliani committed
104
    char str_pd_time[200];
105
106
107

    NMXP_MSG_SERVER type;
    void *buffer;
108
    int32_t length;
109
110
    int ret;

Matteo Quintiliani's avatar
Matteo Quintiliani committed
111
112
    int recv_errno = 0;

113
    char filename[500];
114
    char station_code[20], channel_code[20], network_code[20];
115
116
117
118
119
120
121
122

    NMXP_DATA_PROCESS *pd;

#ifdef HAVE_LIBMSEED
    /* Init mini-SEED variables */
    nmxp_data_seed_init(&data_seed);
#endif

Matteo Quintiliani's avatar
Matteo Quintiliani committed
123
124
125
126
127
128
129
130
#ifndef WIN32
    /* Signal handling, use POSIX calls with standardized semantics */
    struct sigaction sa;

    sa.sa_handler = clientDummyHandler;
    sa.sa_flags = SA_RESTART;
    sigemptyset(&sa.sa_mask);
    sigaction(SIGALRM, &sa, NULL);
131

Matteo Quintiliani's avatar
Matteo Quintiliani committed
132
133
134
135
136
137
138
139
140
141
142
    sa.sa_handler = clientShutdown;
    sigaction(SIGINT, &sa, NULL);
    sigaction(SIGQUIT, &sa, NULL); 
    sigaction(SIGTERM, &sa, NULL);

    sa.sa_handler = SIG_IGN;
    sigaction(SIGHUP, &sa, NULL);
    sigaction(SIGPIPE, &sa, NULL); 
#endif

    /* Default is normal output */
143
144
145
146
147
148
149
    nmxp_log(-1, 0);

    /* Initialize params from argument values */
    if(nmxptool_getopt_long(argc, argv, &params) != 0) {
	return 1;
    }

150
    if(params.ew_configuration_file) {
Matteo Quintiliani's avatar
Matteo Quintiliani committed
151
152
153
154
155
156
157

#ifdef HAVE_EARTHWORMOBJS
	nmxptool_ew_configure(argv, &params);
	/* Check consistency of params */
	if(nmxptool_check_params(&params) != 0) {
	    return 1;
	}
158
	nmxp_log_init(nmxptool_ew_logit_msg, nmxptool_ew_logit_err);
Matteo Quintiliani's avatar
Matteo Quintiliani committed
159
#endif
160

161
    } else {
Matteo Quintiliani's avatar
Matteo Quintiliani committed
162

Matteo Quintiliani's avatar
Matteo Quintiliani committed
163
164
	nmxp_log_init(nmxp_log_stdout, nmxp_log_stderr);

165
166
167
168
169
	/* Check consistency of params */
	if(nmxptool_check_params(&params) != 0) {
	    return 1;
	}

170
171
172
	if(params.flag_verbose) {
	    nmxp_log(-1, 2);
	}
173

174
175
	/* List available channels on server */
	if(params.flag_listchannels) {
176

177
178
179
180
	    // TOREMOVE
	    // channelList = nmxp_getAvailableChannelList(params.hostname, params.portnumberpds, NMXP_DATA_TIMESERIES);
	    // TOREMOVE
	    // nmxp_chan_print_channelList(channelList);
181

182
	    nmxp_getMetaChannelList(params.hostname, params.portnumberdap, NMXP_DATA_TIMESERIES, params.flag_request_channelinfo);
183

184
185
186
	    return 1;
	}
    }
187

188
189
    /* Get list of available channels and get a subset list of params.channels */
    channelList = nmxp_getAvailableChannelList(params.hostname, params.portnumberpds, NMXP_DATA_TIMESERIES);
190
    channelList_subset = nmxp_chan_subset(channelList, NMXP_DATA_TIMESERIES, params.channels, CURRENT_NETWORK);
191
192
193

    /* Check if some channel already exists */
    if(channelList_subset->number <= 0) {
194
	nmxp_log(NMXP_LOG_ERR, 0, "Channels not found!\n");
195
	return 1;
Matteo Quintiliani's avatar
Matteo Quintiliani committed
196
197
    } else {
	nmxp_chan_print_channelList(channelList_subset);
Matteo Quintiliani's avatar
Matteo Quintiliani committed
198

199
	nmxp_log(NMXP_LOG_NORM, 1, "Init channelListSeq.\n");
200
201
202
203
204
205

	/* init channelListSeq */
	channelListSeq = (NMXPTOOL_CHAN_SEQ *) malloc(sizeof(NMXPTOOL_CHAN_SEQ) * channelList_subset->number);
	for(i_chan = 0; i_chan < channelList_subset->number; i_chan++) {
	    channelListSeq[i_chan].significant = 0;
	    channelListSeq[i_chan].last_time = 0.0;
Matteo Quintiliani's avatar
Matteo Quintiliani committed
206
	    channelListSeq[i_chan].last_time_call_raw_stream = 0;
Matteo Quintiliani's avatar
Matteo Quintiliani committed
207
	    channelListSeq[i_chan].x_1 = 0;
Matteo Quintiliani's avatar
Matteo Quintiliani committed
208
	    nmxp_raw_stream_init(&(channelListSeq[i_chan].raw_stream_buffer), params.max_tolerable_latency, params.timeoutrecv);
209
210
	}

Matteo Quintiliani's avatar
Matteo Quintiliani committed
211
#ifdef HAVE_LIBMSEED
212
	nmxp_log(NMXP_LOG_NORM, 1, "Init mini-SEED record list.\n");
213
214

	/* Init mini-SEED record list */
Matteo Quintiliani's avatar
Matteo Quintiliani committed
215
	for(i_chan = 0; i_chan < channelList_subset->number; i_chan++) {
216

217
	    nmxp_log(NMXP_LOG_NORM, 1, "Init mini-SEED record for %s\n", channelList_subset->channel[i_chan].name);
218
219
220
221

	    msr_list_chan[i_chan] = msr_init(NULL);

	    /* Separate station_code and channel_code */
222
	    if(nmxp_chan_cpy_sta_chan(channelList_subset->channel[i_chan].name, station_code, channel_code, network_code)) {
223

224
		nmxp_log(NMXP_LOG_NORM, 1, "%s.%s.%s\n", NETCODE_OR_CURRENT_NETWORK, station_code, channel_code);
225

226
		strcpy(msr_list_chan[i_chan]->network, NETCODE_OR_CURRENT_NETWORK);
227
228
229
230
231
232
233
		strcpy(msr_list_chan[i_chan]->station, station_code);
		strcpy(msr_list_chan[i_chan]->channel, channel_code);

		msr_list_chan[i_chan]->reclen = 512;         /* byte record length */
		msr_list_chan[i_chan]->encoding = DE_STEIM1;  /* Steim 1 compression */

	    } else {
234
		nmxp_log(NMXP_LOG_ERR, 0, "Channels %s error in format!\n");
235
236
237
		return 1;
	    }

Matteo Quintiliani's avatar
Matteo Quintiliani committed
238
239
	}
#endif
240

241
242
243
244
245
246
247
248
    }

    /* Free the complete channel list */
    if(channelList) {
	free(channelList);
	channelList = NULL;
    }

249
    nmxp_log(NMXP_LOG_NORM, 1, "Starting comunication.\n");
Matteo Quintiliani's avatar
Matteo Quintiliani committed
250

251
    /* TODO condition starting DAP or PDS */
252
253
254
    if( (params.start_time != 0   &&   params.end_time != 0)
	    || params.delay > 0
	    ) {
255

Matteo Quintiliani's avatar
Matteo Quintiliani committed
256
	if(params.delay > 0) {
Matteo Quintiliani's avatar
Matteo Quintiliani committed
257
	    params.start_time = ((time(NULL) - params.delay - span_interval) / 10) * 10;
Matteo Quintiliani's avatar
Matteo Quintiliani committed
258
259
260
	    params.end_time = params.start_time + span_interval;
	}

261

262
263
264
	/* ************************************************************** */
	/* Start subscription protocol "DATA ACCESS PROTOCOL" version 1.0 */
	/* ************************************************************** */
265

266
267
	/* DAP Step 1: Open a socket */
	if( (naqssock = nmxp_openSocket(params.hostname, params.portnumberdap)) == NMXP_SOCKET_ERROR) {
268
	    nmxp_log(NMXP_LOG_ERR, 0, "Error opening socket!\n");
269
270
	    return 1;
	}
271

272
273
	/* DAP Step 2: Read connection time */
	if(nmxp_readConnectionTime(naqssock, &connection_time) != NMXP_SOCKET_OK) {
274
	    nmxp_log(NMXP_LOG_ERR, 0, "Error reading connection time from server!\n");
275
276
	    return 1;
	}
277

278
279
	/* DAP Step 3: Send a ConnectRequest */
	if(nmxp_sendConnectRequest(naqssock, params.datas_username, params.datas_password, connection_time) != NMXP_SOCKET_OK) {
280
	    nmxp_log(NMXP_LOG_ERR, 0, "Error sending connect request!\n");
281
282
283
284
285
	    return 1;
	}

	/* DAP Step 4: Wait for a Ready message */
	if(nmxp_waitReady(naqssock) != NMXP_SOCKET_OK) {
286
	    nmxp_log(NMXP_LOG_ERR, 0, "Error waiting Ready message!\n");
287
288
	    return 1;
	}
289

290
291
292
293
	exitdapcondition = 1;

	while(exitdapcondition) {

294
	nmxp_log(NMXP_LOG_NORM, 1, "start_time = %d - end_time = %d\n", params.start_time, params.end_time);
295

296
297
298
	/* Start loop for sending requests */
	i_chan=0;
	request_SOCKET_OK = NMXP_SOCKET_OK;
299

300
	while(request_SOCKET_OK == NMXP_SOCKET_OK  &&  i_chan < channelList_subset->number) {
301

302
	    /* DAP Step 5: Send Data Request */
Matteo Quintiliani's avatar
Matteo Quintiliani committed
303
	    request_SOCKET_OK = nmxp_sendDataRequest(naqssock, channelList_subset->channel[i_chan].key, (double) params.start_time, (double) params.end_time);
304

305
	    if(request_SOCKET_OK == NMXP_SOCKET_OK) {
306

307
308
309
310
311
		nmxp_data_to_str(str_start_time, params.start_time);
		nmxp_data_to_str(str_end_time, params.end_time);
		nmxptool_str_time_to_filename(str_start_time);
		nmxptool_str_time_to_filename(str_end_time);

312
313
		if(params.flag_writefile) {
		    /* Open output file */
314
315
316
317
318
319
320
321
322
323
324
325
326
		    if(nmxp_chan_cpy_sta_chan(channelList_subset->channel[i_chan].name, station_code, channel_code, network_code)) {
			sprintf(filename, "%s.%s.%s_%s_%s.nmx",
				NETCODE_OR_CURRENT_NETWORK,
				station_code,
				channel_code,
				str_start_time,
				str_end_time);
		    } else {
			sprintf(filename, "%s_%s_%s.nmx",
				channelList_subset->channel[i_chan].name,
				str_start_time,
				str_end_time);
		    }
327

328
329
		    outfile = fopen(filename, "w");
		    if(!outfile) {
330
			nmxp_log(NMXP_LOG_ERR, 0, "Can not to open file %s!", filename);
331
		    }
332
333
334
		}

#ifdef HAVE_LIBMSEED
335
336
		if(params.flag_writeseed) {
		    /* Open output Mini-SEED file */
337
338
339
340
341
342
343
344
345
346
347
348
349
		    if(nmxp_chan_cpy_sta_chan(channelList_subset->channel[i_chan].name, station_code, channel_code, network_code)) {
			sprintf(data_seed.filename_mseed, "%s.%s.%s_%s_%s.miniseed",
				NETCODE_OR_CURRENT_NETWORK,
				station_code,
				channel_code,
				str_start_time,
				str_end_time);
		    } else {
			sprintf(filename, "%s_%s_%s.miniseed",
				channelList_subset->channel[i_chan].name,
				str_start_time,
				str_end_time);
		    }
350

351
352
		    data_seed.outfile_mseed = fopen(data_seed.filename_mseed, "w");
		    if(!data_seed.outfile_mseed) {
353
			nmxp_log(NMXP_LOG_ERR, 0, "Can not to open file %s!", data_seed.filename_mseed);
354
355
356
		    }
		}
#endif
357

358
359
360
		if(params.flag_writefile  &&  outfile) {
		    /* Compute SNCL line */

361
		    /* Separate station_code_old_way and channel_code_old_way */
362
		    if(nmxp_chan_cpy_sta_chan(channelList_subset->channel[i_chan].name, station_code, channel_code, network_code)) {
363
364
365
			/* Write SNCL line */
			fprintf(outfile, "%s.%s.%s.%s\n",
				station_code,
366
				NETCODE_OR_CURRENT_NETWORK,
367
368
				channel_code,
				(params.location)? params.location : "");
369
		    }
370
371
372

		}

373
		/* DAP Step 6: Receive Data until receiving a Ready message */
Matteo Quintiliani's avatar
Matteo Quintiliani committed
374
		ret = nmxp_receiveMessage(naqssock, &type, &buffer, &length, 0, &recv_errno);
375
		nmxp_log(NMXP_LOG_NORM, 1, "ret = %d, type = %d\n", ret, type);
376

377
		while(ret == NMXP_SOCKET_OK   &&    type != NMXP_MSG_READY) {
378

379
		    /* Process a packet and return value in NMXP_DATA_PROCESS structure */
380
		    pd = nmxp_processCompressedData(buffer, length, channelList_subset, NETCODE_OR_CURRENT_NETWORK);
Matteo Quintiliani's avatar
Matteo Quintiliani committed
381
		    nmxp_data_trim(pd, params.start_time, params.end_time, 0);
Matteo Quintiliani's avatar
Matteo Quintiliani committed
382
383

		    /* Log contents of last packet */
384
385
386
		    if(params.flag_logdata) {
			nmxp_data_log(pd);
		    }
387

388
		    /* Set cur_chan */
389
		    cur_chan = nmxp_chan_lookupKeyIndex(pd->key, channelList_subset);
390
391

		    /* Management of gaps */
Matteo Quintiliani's avatar
Matteo Quintiliani committed
392
		    if(!channelListSeq[cur_chan].significant && pd->nSamp > 0) {
393
394
			channelListSeq[cur_chan].significant = 1;
		    } else {
Matteo Quintiliani's avatar
Matteo Quintiliani committed
395
			if(channelListSeq[cur_chan].significant) {
396
397
			    if(nmxptool_check_and_log_gap(pd->time, channelListSeq[cur_chan].last_time, GAP_TOLLERANCE, pd->station, pd->channel)) {
				channelListSeq[cur_chan].x_1 = 0;
Matteo Quintiliani's avatar
Matteo Quintiliani committed
398
399
				nmxp_data_to_str(str_pd_time, pd->time);
				nmxp_log(NMXP_LOG_WARN, 0, "%s.%s x0 set to zero at %s!\n", pd->station, pd->channel, str_pd_time);
400
			    }
Matteo Quintiliani's avatar
Matteo Quintiliani committed
401
402
			}
		    }
403
		    if(channelListSeq[cur_chan].significant && pd->nSamp > 0) {
Matteo Quintiliani's avatar
Matteo Quintiliani committed
404
			channelListSeq[cur_chan].last_time = pd->time + ((double) pd->nSamp / (double) pd->sampRate);
405
406
		    }

407
#ifdef HAVE_LIBMSEED
408
409
		    /* Write Mini-SEED record */
		    if(params.flag_writeseed) {
410
			nmxptool_write_miniseed(pd);
411
		    }
412
#endif
413

414
#ifdef HAVE___SRC_SEEDLINK_PLUGIN_C
415
		    /* Send data to SeedLink Server */
416
		    if(params.flag_slink) {
417
			nmxptool_send_raw_depoch(pd);
418
		    }
419
420
#endif

421
422
423
		    if(params.flag_writefile  &&  outfile) {
			/* Write buffer to the output file */
			if(outfile && buffer && length > 0) {
424
			    int32_t length_int = length;
425
426
427
428
429
			    nmxp_data_swap_4b((int32_t *) &length_int);
			    fwrite(&length_int, sizeof(length_int), 1, outfile);
			    fwrite(buffer, length, 1, outfile);
			}
		    }
430

Matteo Quintiliani's avatar
Matteo Quintiliani committed
431
432
433
434
435
		    /* Store x_1 */
		    if(pd->nSamp > 0) {
			channelListSeq[cur_chan].x_1 = pd->pDataPtr[pd->nSamp-1];
		    }
		    /* Free pd->buffer */
Matteo Quintiliani's avatar
Matteo Quintiliani committed
436
437
438
		    if(pd->buffer) {
			free(pd->buffer);
			pd->buffer = NULL;
439
		    }
440
441

		    /* Receive Data */
Matteo Quintiliani's avatar
Matteo Quintiliani committed
442
		    ret = nmxp_receiveMessage(naqssock, &type, &buffer, &length, 0, &recv_errno);
443
		    nmxp_log(NMXP_LOG_NORM, 1, "ret = %d, type = %d\n", ret, type);
444
445
		}

446
447
448
		if(params.flag_writefile  &&  outfile) {
		    /* Close output file */
		    fclose(outfile);
Matteo Quintiliani's avatar
Matteo Quintiliani committed
449
		    outfile = NULL;
450
451
		}

452
453
454
455
#ifdef HAVE_LIBMSEED
		if(params.flag_writeseed  &&  data_seed.outfile_mseed) {
		    /* Close output Mini-SEED file */
		    fclose(data_seed.outfile_mseed);
Matteo Quintiliani's avatar
Matteo Quintiliani committed
456
		    data_seed.outfile_mseed = NULL;
457
458
		}
#endif
459
460

	    }
461
462
463
	    i_chan++;
	}
	/* DAP Step 7: Repeat steps 5 and 6 for each data request */
464

Matteo Quintiliani's avatar
Matteo Quintiliani committed
465
	if(params.delay > 0) {
Matteo Quintiliani's avatar
Matteo Quintiliani committed
466
467
468
469
	    time_to_sleep = (params.end_time - params.start_time) - (time(NULL) - (params.start_time + params.delay + span_interval));
	    if(time_to_sleep >= 0) {
		sleep(time_to_sleep);
	    } else {
470
		nmxp_log(NMXP_LOG_ERR, 0, "time to sleep %dsec.\n", time_to_sleep);
Matteo Quintiliani's avatar
Matteo Quintiliani committed
471
472
		sleep(3);
	    }
Matteo Quintiliani's avatar
Matteo Quintiliani committed
473
474
475
476
477
478
	    params.start_time = params.end_time;
	    params.end_time = params.start_time + span_interval;
	} else {
	    exitdapcondition = 0;
	}

479

Matteo Quintiliani's avatar
Matteo Quintiliani committed
480
    } /* END while(exitdapcondition) */
481

482
483
484
485
486
487
488
489
490
491
492
	/* DAP Step 8: Send a Terminate message (optional) */
	nmxp_sendTerminateSubscription(naqssock, NMXP_SHUTDOWN_NORMAL, "Bye!");

	/* DAP Step 9: Close the socket */
	nmxp_closeSocket(naqssock);

	/* ************************************************************ */
	/* End subscription protocol "DATA ACCESS PROTOCOL" version 1.0 */
	/* ************************************************************ */


493

Matteo Quintiliani's avatar
Matteo Quintiliani committed
494
    } else {
495

496
497
	if(params.stc == -1) {

498

499
500
501
502
	    if(params.flag_logdata) {
		p_func_pd[n_func_pd++] = nmxptool_print_seq_no;
	    }

503
504
505
506
507
508
509
510
511
512
513
514
515
#ifdef HAVE_LIBMSEED
	    /* Write Mini-SEED record */
	    if(params.flag_writeseed) {
		p_func_pd[n_func_pd++] = nmxptool_write_miniseed;
	    }
#endif

#ifdef HAVE___SRC_SEEDLINK_PLUGIN_C
	    /* Send data to SeedLink Server */
	    if(params.flag_slink) {
		p_func_pd[n_func_pd++] = nmxptool_send_raw_depoch;
	    }
#endif
Matteo Quintiliani's avatar
Matteo Quintiliani committed
516
517
518
519
520
521
522

#ifdef HAVE_EARTHWORMOBJS
	    if(params.ew_configuration_file) {
		p_func_pd[n_func_pd++] = nmxptool_ew_nmx2ew;
	    }
#endif

523
	}
524

525
526
527
528
529
530
531
532
533
	/* ************************************************************* */
	/* Start subscription protocol "PRIVATE DATA STREAM" version 1.4 */
	/* ************************************************************* */

	/* PDS Step 1: Open a socket */
	naqssock = nmxp_openSocket(params.hostname, params.portnumberpds);

	if(naqssock == NMXP_SOCKET_ERROR) {
	    return 1;
534
535
	}

536
537
538
539
540
541
542
543
544
545
546
547
548
	/* PDS Step 2: Send a Connect */
	if(nmxp_sendConnect(naqssock) != NMXP_SOCKET_OK) {
	    printf("Error on sendConnect()\n");
	    return 1;
	}

	/* PDS Step 3: Receive ChannelList */
	if(nmxp_receiveChannelList(naqssock, &channelList) != NMXP_SOCKET_OK) {
	    printf("Error on receiveChannelList()\n");
	    return 1;
	}

	/* Get a subset of channel from arguments */
549
	channelList_subset = nmxp_chan_subset(channelList, NMXP_DATA_TIMESERIES, params.channels, CURRENT_NETWORK);
550
551
552


	/* PDS Step 4: Send a Request Pending (optional) */
553
554


555
556
557
558
559
560
	/* PDS Step 5: Send AddChannels */
	/* Request Data */
	nmxp_sendAddTimeSeriesChannel(naqssock, channelList_subset, params.stc, params.rate, (params.flag_buffered)? NMXP_BUFFER_YES : NMXP_BUFFER_NO);

	/* PDS Step 6: Repeat until finished: receive and handle packets */

Matteo Quintiliani's avatar
Matteo Quintiliani committed
561
562
563
564
#ifdef HAVE_LIBMSEED
	if(params.flag_writeseed) {
	    /* Open output Mini-SEED file */
	    sprintf(data_seed.filename_mseed, "%s.realtime.miniseed",
565
		    CURRENT_NETWORK);
Matteo Quintiliani's avatar
Matteo Quintiliani committed
566
567
568

	    data_seed.outfile_mseed = fopen(data_seed.filename_mseed, "w");
	    if(!data_seed.outfile_mseed) {
569
		nmxp_log(NMXP_LOG_ERR, 0, "Can not to open file %s!", data_seed.filename_mseed);
Matteo Quintiliani's avatar
Matteo Quintiliani committed
570
	    } else {
571
		nmxp_log(NMXP_LOG_NORM, 1, "Opened file %s!\n", data_seed.filename_mseed);
Matteo Quintiliani's avatar
Matteo Quintiliani committed
572
573
574
575
	    }
	}
#endif

Matteo Quintiliani's avatar
Matteo Quintiliani committed
576
577
578
	// TODO
	exitpdscondition = 1;

Matteo Quintiliani's avatar
Matteo Quintiliani committed
579
580
581
582
583
584
#ifdef HAVE_EARTHWORMOBJS
	if(params.ew_configuration_file) {
	    nmxptool_ew_attach();
	}
#endif

585
	
Matteo Quintiliani's avatar
Matteo Quintiliani committed
586
	while(exitpdscondition) {
Matteo Quintiliani's avatar
Matteo Quintiliani committed
587

588
	    /* Process Compressed or Decompressed Data */
Matteo Quintiliani's avatar
Matteo Quintiliani committed
589
	    pd = nmxp_receiveData(naqssock, channelList_subset, NETCODE_OR_CURRENT_NETWORK, params.timeoutrecv, &recv_errno);
Matteo Quintiliani's avatar
Matteo Quintiliani committed
590

591
	    if(recv_errno == 0) {
Matteo Quintiliani's avatar
Matteo Quintiliani committed
592
593
594
		// TODO
		exitpdscondition = 1;
	    } else {
595
		nmxp_log(NMXP_LOG_ERR, 0, "Error receiving data. pd=%p recv_errno=%d\n", pd, recv_errno);
Matteo Quintiliani's avatar
Matteo Quintiliani committed
596
597
		exitpdscondition = 0;
	    }
598

Matteo Quintiliani's avatar
Matteo Quintiliani committed
599
	    /* Log contents of last packet */
600
601
602
	    if(params.flag_logdata) {
		nmxp_data_log(pd);
	    }
Matteo Quintiliani's avatar
Matteo Quintiliani committed
603

Matteo Quintiliani's avatar
Matteo Quintiliani committed
604
	    if(pd) {
Matteo Quintiliani's avatar
Matteo Quintiliani committed
605
606
		/* Set cur_chan */
		cur_chan = nmxp_chan_lookupKeyIndex(pd->key, channelList_subset);
Matteo Quintiliani's avatar
Matteo Quintiliani committed
607
	    }
608

609
610
	    /* Manage Raw Stream */
	    if(params.stc == -1) {
Matteo Quintiliani's avatar
Matteo Quintiliani committed
611
612
613
614
615
616
617
618
619

		/* cur_char is computed only for pd != NULL */
		if(pd) {
		    nmxp_raw_stream_manage(&(channelListSeq[cur_chan].raw_stream_buffer), pd, p_func_pd, n_func_pd);
		    channelListSeq[cur_chan].last_time_call_raw_stream = nmxp_data_gmtime_now();
		}

		/* Check timeout for other channels */
		if(params.timeoutrecv > 0) {
Matteo Quintiliani's avatar
Matteo Quintiliani committed
620
		    exitpdscondition = 1;
Matteo Quintiliani's avatar
Matteo Quintiliani committed
621
622
623
624
625
626
627
628
629
630
631
632
633
634
		    to_cur_chan = 0;
		    while(to_cur_chan < channelList_subset->number) {
			timeout_for_channel = nmxp_data_gmtime_now() - channelListSeq[to_cur_chan].last_time_call_raw_stream;
			if(channelListSeq[to_cur_chan].last_time_call_raw_stream != 0
				&& timeout_for_channel >= params.timeoutrecv) {
			    nmxp_log(NMXP_LOG_WARN, 0, "Timeout for channel %s (%d sec.)\n",
				    channelList_subset->channel[to_cur_chan].name, timeout_for_channel);
			    nmxp_raw_stream_manage(&(channelListSeq[to_cur_chan].raw_stream_buffer), NULL, p_func_pd, n_func_pd);
			    channelListSeq[to_cur_chan].last_time_call_raw_stream = nmxp_data_gmtime_now();
			}
			to_cur_chan++;
		    }
		}

635
	    } else {
636

Matteo Quintiliani's avatar
Matteo Quintiliani committed
637
	    if(pd) {
638
639
640
641
642
643
644
		/* Management of gaps */
		if(!channelListSeq[cur_chan].significant && pd->nSamp > 0) {
		    channelListSeq[cur_chan].significant = 1;
		} else {
		    if(channelListSeq[cur_chan].significant) {
			if(nmxptool_check_and_log_gap(pd->time, channelListSeq[cur_chan].last_time, GAP_TOLLERANCE, pd->station, pd->channel)) {
			    channelListSeq[cur_chan].x_1 = 0;
Matteo Quintiliani's avatar
Matteo Quintiliani committed
645
646
			    nmxp_data_to_str(str_pd_time, pd->time);
			    nmxp_log(NMXP_LOG_WARN, 0, "%s.%s x0 set to zero at %s!\n", pd->station, pd->channel, str_pd_time);
647
			}
648
		    }
Matteo Quintiliani's avatar
Matteo Quintiliani committed
649
		}
650
651
652
		if(channelListSeq[cur_chan].significant && pd->nSamp > 0) {
		    channelListSeq[cur_chan].last_time = pd->time + ((double) pd->nSamp / (double) pd->sampRate);
		}
653

Matteo Quintiliani's avatar
Matteo Quintiliani committed
654
655

#ifdef HAVE_LIBMSEED
656
657
658
659
		/* Write Mini-SEED record */
		if(params.flag_writeseed) {
		    nmxptool_write_miniseed(pd);
		}
Matteo Quintiliani's avatar
Matteo Quintiliani committed
660
661
#endif

662
#ifdef HAVE___SRC_SEEDLINK_PLUGIN_C
663
664
665
666
		/* Send data to SeedLink Server */
		if(params.flag_slink) {
		    nmxptool_send_raw_depoch(pd);
		}
667
#endif
668
	    }
Matteo Quintiliani's avatar
Matteo Quintiliani committed
669
	    }
670

Matteo Quintiliani's avatar
Matteo Quintiliani committed
671
	    if(pd) {
Matteo Quintiliani's avatar
Matteo Quintiliani committed
672
673
674
675
676
	    /* Store x_1 */
	    if(pd->nSamp > 0) {
		channelListSeq[cur_chan].x_1 = pd->pDataPtr[pd->nSamp-1];
	    }
	    /* Free pd->buffer */
Matteo Quintiliani's avatar
Matteo Quintiliani committed
677
678
679
680
	    if(pd->buffer) {
		free(pd->buffer);
		pd->buffer = NULL;
	    }
Matteo Quintiliani's avatar
Matteo Quintiliani committed
681
	    }
Matteo Quintiliani's avatar
Matteo Quintiliani committed
682

Matteo Quintiliani's avatar
Matteo Quintiliani committed
683
684
685
686
687
688
689
690
691
692
693
694
695
696
697
#ifdef HAVE_EARTHWORMOBJS
	    if(params.ew_configuration_file) {

		/* Check if we are being asked to terminate */
		if( nmxptool_ew_check_flag_terminate() ) {
		    logit ("t", "nmxptool terminating on request\n");
		    exitpdscondition = 0;
		}

		/* Check if we need to send heartbeat message */
		nmxptool_ew_send_heartbeat_if_needed();

	    }
#endif

Matteo Quintiliani's avatar
Matteo Quintiliani committed
698
	}
Matteo Quintiliani's avatar
Matteo Quintiliani committed
699
700
701
	
	/* Flush raw data stream for each channel */
	flushing_raw_data_stream();
Matteo Quintiliani's avatar
Matteo Quintiliani committed
702

Matteo Quintiliani's avatar
Matteo Quintiliani committed
703
704
705
706
707
708
#ifdef HAVE_EARTHWORMOBJS
	if(params.ew_configuration_file) {
	    nmxptool_ew_detach();
	}
#endif

Matteo Quintiliani's avatar
Matteo Quintiliani committed
709
710
711
712
713
714
715
#ifdef HAVE_LIBMSEED
	if(params.flag_writeseed  &&  data_seed.outfile_mseed) {
	    /* Close output Mini-SEED file */
	    fclose(data_seed.outfile_mseed);
	}
#endif

716
717
718
719
720
721
722
723
724
725
726

	/* PDS Step 7: Send Terminate Subscription */
	nmxp_sendTerminateSubscription(naqssock, NMXP_SHUTDOWN_NORMAL, "Good Bye!");

	/* PDS Step 8: Close the socket */
	nmxp_closeSocket(naqssock);

	/* *********************************************************** */
	/* End subscription protocol "PRIVATE DATA STREAM" version 1.4 */
	/* *********************************************************** */

727
728


729
    }
730

731
732
733
734
735
736
737
738
739
740
#ifdef HAVE_LIBMSEED
	if(*msr_list_chan) {
	    for(i_chan = 0; i_chan < channelList_subset->number; i_chan++) {
		if(msr_list_chan[i_chan]) {
		    msr_free(&(msr_list_chan[i_chan]));
		}
	    }
	}
#endif

741
	for(i_chan = 0; i_chan < channelList_subset->number; i_chan++) {
742
	    nmxp_raw_stream_free(&(channelListSeq[i_chan].raw_stream_buffer));
743
744
	}

745
746
747
748
749
750
751
752
753
	if(channelListSeq) {
	    free(channelListSeq);
	}

	/* This has to be tha last */
	if(channelList_subset) {
	    free(channelList_subset);
	}

754
    return 0;
755
} /* End MAIN */
756
757
758
759




Matteo Quintiliani's avatar
Matteo Quintiliani committed
760
761
762
763
764
765
766
767
768
769
770
771
772
773
static void flushing_raw_data_stream() {
    int to_cur_chan;

    /* Flush raw data stream for each channel */
    if(params.stc == -1) {
	to_cur_chan = 0;
	while(to_cur_chan < channelList_subset->number) {
	    nmxp_log(NMXP_LOG_WARN, 0, "Flushing data for channel %s\n",
		    channelList_subset->channel[to_cur_chan].name);
	    nmxp_raw_stream_manage(&(channelListSeq[to_cur_chan].raw_stream_buffer), NULL, p_func_pd, n_func_pd);
	    to_cur_chan++;
	}
    }
}
774

Matteo Quintiliani's avatar
Matteo Quintiliani committed
775
776
/* Do any needed cleanup and exit */
static void clientShutdown(int sig) {
777

778
    nmxp_log(NMXP_LOG_NORM, 0, "Program interrupted!\n");
Matteo Quintiliani's avatar
Matteo Quintiliani committed
779

Matteo Quintiliani's avatar
Matteo Quintiliani committed
780
781
    flushing_raw_data_stream();

Matteo Quintiliani's avatar
Matteo Quintiliani committed
782
783
784
785
786
    if(params.flag_writefile  &&  outfile) {
	/* Close output file */
	fclose(outfile);
    }

787
788
789
790
791
792
#ifdef HAVE_EARTHWORMOBJS
	if(params.ew_configuration_file) {
	    nmxptool_ew_detach();
	}
#endif

Matteo Quintiliani's avatar
Matteo Quintiliani committed
793
794
795
796
797
798
799
#ifdef HAVE_LIBMSEED
    if(params.flag_writeseed  &&  data_seed.outfile_mseed) {
	/* Close output Mini-SEED file */
	fclose(data_seed.outfile_mseed);
    }
#endif

800

Matteo Quintiliani's avatar
Matteo Quintiliani committed
801
802
803
804
805
806
    /* PDS Step 7: Send Terminate Subscription */
    nmxp_sendTerminateSubscription(naqssock, NMXP_SHUTDOWN_NORMAL, "Good Bye!");

    /* PDS Step 8: Close the socket */
    nmxp_closeSocket(naqssock);

807

Matteo Quintiliani's avatar
Matteo Quintiliani committed
808
809
810
    if(channelList == NULL) {
	free(channelList);
    }
811

812
813
    int i_chan = 0;

814
815
816
817
818
819
820
821
822
823
#ifdef HAVE_LIBMSEED
    if(*msr_list_chan) {
	for(i_chan = 0; i_chan < channelList_subset->number; i_chan++) {
	    if(msr_list_chan[i_chan]) {
		msr_free(&(msr_list_chan[i_chan]));
	    }
	}
    }
#endif

824
    for(i_chan = 0; i_chan < channelList_subset->number; i_chan++) {
825
	nmxp_raw_stream_free(&(channelListSeq[i_chan].raw_stream_buffer));
826
827
    }

828
829
830
831
832
    if(channelListSeq) {
	free(channelListSeq);
    }

    /* This has to be the last */
Matteo Quintiliani's avatar
Matteo Quintiliani committed
833
834
835
836
837
838
    if(channelList_subset == NULL) {
	free(channelList_subset);
    }

    exit( sig );
} /* End of clientShutdown() */
839

Matteo Quintiliani's avatar
Matteo Quintiliani committed
840
841
842
843

/* Empty signal handler routine */
static void clientDummyHandler(int sig) {
}
Matteo Quintiliani's avatar
Matteo Quintiliani committed
844
845
846
847




848
#ifdef HAVE_LIBMSEED
Matteo Quintiliani's avatar
Matteo Quintiliani committed
849
850
851
852
853
int nmxptool_write_miniseed(NMXP_DATA_PROCESS *pd) {
    int cur_chan;
    int ret = 0;
    if( (cur_chan = nmxp_chan_lookupKeyIndex(pd->key, channelList_subset)) != -1) {

854
	ret = nmxp_data_msr_pack(pd, &data_seed, msr_list_chan[cur_chan]);
Matteo Quintiliani's avatar
Matteo Quintiliani committed
855
856

    } else {
857
	nmxp_log(NMXP_LOG_ERR, 0, "Key %d not found in channelList_subset!\n", pd->key);
Matteo Quintiliani's avatar
Matteo Quintiliani committed
858
859
860
    }
    return ret;
}
861
#endif
Matteo Quintiliani's avatar
Matteo Quintiliani committed
862

863
864
int nmxptool_print_seq_no(NMXP_DATA_PROCESS *pd) {
    int ret = 0;
Matteo Quintiliani's avatar
Matteo Quintiliani committed
865
866
    char str_time[200];
    nmxp_data_to_str(str_time, pd->time);
867

Matteo Quintiliani's avatar
Matteo Quintiliani committed
868
869
    nmxp_log(NMXP_LOG_NORM_NO, 0, "Process %s.%s.%s %2d %d %d %s %dpts lat. %.1fs\n",
	    pd->network,
Matteo Quintiliani's avatar
Matteo Quintiliani committed
870
871
	    pd->station,
	    pd->channel,
872
873
	    pd->packet_type,
	    pd->seq_no,
874
	    pd->oldest_seq_no,
Matteo Quintiliani's avatar
Matteo Quintiliani committed
875
876
	    str_time,
	    pd->nSamp,
877
	    nmxp_data_latency(pd)
878
879
880
881
882
	    );

    return ret;
}

883

Matteo Quintiliani's avatar
Matteo Quintiliani committed
884
#ifdef HAVE___SRC_SEEDLINK_PLUGIN_C
Matteo Quintiliani's avatar
Matteo Quintiliani committed
885
886
887
888
889
890
891
892
int nmxptool_send_raw_depoch(NMXP_DATA_PROCESS *pd) {
    /* TODO Set values */
    const int usec_correction = 0;
    const int timing_quality = 100;

    return send_raw_depoch(pd->station, pd->channel, pd->time, usec_correction, timing_quality,
	    pd->pDataPtr, pd->nSamp);
}
Matteo Quintiliani's avatar
Matteo Quintiliani committed
893
#endif
Matteo Quintiliani's avatar
Matteo Quintiliani committed
894
895
896
897



int nmxptool_check_and_log_gap(double time1, double time2, const double gap_tollerance, const char *station, const char *channel) {
898
899
    char str_time1[200];
    char str_time2[200];
Matteo Quintiliani's avatar
Matteo Quintiliani committed
900
901
    int ret = 0;
    double gap = time1 - time2 ;
902
903
    nmxp_data_to_str(str_time1, time1);
    nmxp_data_to_str(str_time2, time2);
Matteo Quintiliani's avatar
Matteo Quintiliani committed
904
    if(gap > gap_tollerance) {
905
	nmxp_log(NMXP_LOG_ERR, 0, "Gap %.2f sec. for %s.%s from %s to %s!\n", gap, station, channel, str_time2, str_time1);
Matteo Quintiliani's avatar
Matteo Quintiliani committed
906
907
	ret = 1;
    } else if (gap < -gap_tollerance) {
908
	nmxp_log(NMXP_LOG_ERR, 0, "Overlap %.2f sec. for %s.%s from %s to %s!\n", gap, station, channel, str_time1, str_time2);
Matteo Quintiliani's avatar
Matteo Quintiliani committed
909
910
911
912
	ret = 1;
    }
    return ret;
}
913

Matteo Quintiliani's avatar
Matteo Quintiliani committed
914
void nmxptool_str_time_to_filename(char *str_time) {
915
916
917
918
919
920
921
922
923
924
925
926
927
    int i;
    for(i=0; i<strlen(str_time); i++) {
	if(   (str_time[i] >= 'A'  &&  str_time[i] <= 'Z')
		|| (str_time[i] >= 'a'  &&  str_time[i] <= 'z')
		|| (str_time[i] >= '0'  &&  str_time[i] <= '9')
		|| (str_time[i] == '_')
	  ) {
	    /* Do nothing */
	} else {
	    str_time[i] = '.';
	}
    }
}