nmxptool.c 20.4 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.68 2007-09-27 15:08:57 mtheo Exp $
Matteo Quintiliani's avatar
Matteo Quintiliani committed
11
 *
Matteo Quintiliani's avatar
Matteo Quintiliani committed
12
13
 */

14
15
16
17
18
#include <stdio.h>
#include <stdlib.h>
#include <string.h>

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

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

24
#include "config.h"
25
26
#include "nmxptool_getoptlong.h"

27
28
29
#ifdef HAVE_LIBMSEED
#include <libmseed.h>
#endif
30

31
32
#ifdef HAVE___SRC_SEEDLINK_PLUGIN_H
#include "seedlink_plugin.h"
33
34
#endif

Matteo Quintiliani's avatar
Matteo Quintiliani committed
35
36
#define CURRENT_NETWORK (params.network)? params.network : DEFAULT_NETWORK
#define GAP_TOLLERANCE 0.001
37

38
39
40
41
typedef struct {
    int significant;
    double last_time;
    int32_t x_1;
42
    NMXP_RAW_STREAM_DATA raw_stream_buffer;
43
44
} NMXPTOOL_CHAN_SEQ;

Matteo Quintiliani's avatar
Matteo Quintiliani committed
45
46
47
static void clientShutdown(int sig);
static void clientDummyHandler(int sig);

48
#ifdef HAVE_LIBMSEED
Matteo Quintiliani's avatar
Matteo Quintiliani committed
49
int nmxptool_write_miniseed(NMXP_DATA_PROCESS *pd);
50
51
#endif

Matteo Quintiliani's avatar
Matteo Quintiliani committed
52
int nmxptool_send_raw_depoch(NMXP_DATA_PROCESS *pd);
53
int nmxptool_print_seq_no(NMXP_DATA_PROCESS *pd);
Matteo Quintiliani's avatar
Matteo Quintiliani committed
54
55

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
56
void nmxptool_str_time_to_filename(char *str_time);
Matteo Quintiliani's avatar
Matteo Quintiliani committed
57
58


59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
/* Global variable for main program and handling terminitation program */
NMXPTOOL_PARAMS params;
int naqssock = 0;
FILE *outfile = NULL;
NMXP_CHAN_LIST *channelList = NULL;
NMXP_CHAN_LIST *channelList_subset = NULL;
NMXPTOOL_CHAN_SEQ *channelListSeq = NULL;

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


74
int main (int argc, char **argv) {
75
    int32_t connection_time;
76
    int request_SOCKET_OK;
77
    int i_chan, cur_chan;
Matteo Quintiliani's avatar
Matteo Quintiliani committed
78
    int exitpdscondition;
Matteo Quintiliani's avatar
Matteo Quintiliani committed
79
80
    int exitdapcondition;

Matteo Quintiliani's avatar
Matteo Quintiliani committed
81
    int span_interval = 10;
Matteo Quintiliani's avatar
Matteo Quintiliani committed
82
83
    int time_to_sleep = 0;

84
85
    char str_start_time[200];
    char str_end_time[200];
Matteo Quintiliani's avatar
Matteo Quintiliani committed
86
    char str_pd_time[200];
87
88
89

    NMXP_MSG_SERVER type;
    void *buffer;
90
    int32_t length;
91
92
93
    int ret;

    char filename[500];
94
    char station_code[20], channel_code[20];
95
96
97
98
99
100
101
102

    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
103
104
105
106
107
108
109
110
#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);
111

Matteo Quintiliani's avatar
Matteo Quintiliani committed
112
113
114
115
116
117
118
119
120
121
122
123
    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 */
124
125
126
127
128
129
130
131
132
133
134
135
    nmxp_log(-1, 0);

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

    /* Check consistency of params */
    if(nmxptool_check_params(&params) != 0) {
	return 1;
    }

136
137
138
139
    if(params.flag_verbose) {
	nmxp_log(-1, 2);
    }

140
141
142
    /* List available channels on server */
    if(params.flag_listchannels) {

Matteo Quintiliani's avatar
Matteo Quintiliani committed
143
144
145
146
	// TOREMOVE
	// channelList = nmxp_getAvailableChannelList(params.hostname, params.portnumberpds, NMXP_DATA_TIMESERIES);
	// TOREMOVE
	// nmxp_chan_print_channelList(channelList);
147

148
	nmxp_getMetaChannelList(params.hostname, params.portnumberdap, NMXP_DATA_TIMESERIES, params.flag_request_channelinfo);
149

150
151
152
153
154
155
156
157
158
159
160
	return 1;
    }

    /* Get list of available channels and get a subset list of params.channels */
    channelList = nmxp_getAvailableChannelList(params.hostname, params.portnumberpds, NMXP_DATA_TIMESERIES);
    channelList_subset = nmxp_chan_subset(channelList, NMXP_DATA_TIMESERIES, params.channels);

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

164
165
166
167
168
169
170
	nmxp_log(0, 1, "Init channelListSeq.\n");

	/* 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
171
	    channelListSeq[i_chan].x_1 = 0;
172
	    nmxp_raw_stream_init(&(channelListSeq[i_chan].raw_stream_buffer), params.max_tollerable_latency);
173
174
	}

Matteo Quintiliani's avatar
Matteo Quintiliani committed
175
#ifdef HAVE_LIBMSEED
176
177
178
	nmxp_log(0, 1, "Init mini-SEED record list.\n");

	/* Init mini-SEED record list */
Matteo Quintiliani's avatar
Matteo Quintiliani committed
179
	for(i_chan = 0; i_chan < channelList_subset->number; i_chan++) {
180
181
182
183
184
185
186
187

	    nmxp_log(0, 1, "Init mini-SEED record for %s\n", channelList_subset->channel[i_chan].name);

	    msr_list_chan[i_chan] = msr_init(NULL);

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

188
		nmxp_log(0, 1, "%s.%s.%s\n", CURRENT_NETWORK, station_code, channel_code);
189

190
		strcpy(msr_list_chan[i_chan]->network, CURRENT_NETWORK);
191
192
193
194
195
196
197
198
199
200
201
		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 {
		nmxp_log(1, 0, "Channels %s error in format!\n");
		return 1;
	    }

Matteo Quintiliani's avatar
Matteo Quintiliani committed
202
203
	}
#endif
204

205
206
207
208
209
210
211
212
    }

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

Matteo Quintiliani's avatar
Matteo Quintiliani committed
213
214
    nmxp_log(0, 1, "Starting comunication.\n");

215
    /* TODO condition starting DAP or PDS */
216
217
218
    if( (params.start_time != 0   &&   params.end_time != 0)
	    || params.delay > 0
	    ) {
219

Matteo Quintiliani's avatar
Matteo Quintiliani committed
220
	if(params.delay > 0) {
Matteo Quintiliani's avatar
Matteo Quintiliani committed
221
	    params.start_time = ((time(NULL) - params.delay - span_interval) / 10) * 10;
Matteo Quintiliani's avatar
Matteo Quintiliani committed
222
223
224
	    params.end_time = params.start_time + span_interval;
	}

225

226
227
228
	/* ************************************************************** */
	/* Start subscription protocol "DATA ACCESS PROTOCOL" version 1.0 */
	/* ************************************************************** */
229

230
231
232
233
234
	/* DAP Step 1: Open a socket */
	if( (naqssock = nmxp_openSocket(params.hostname, params.portnumberdap)) == NMXP_SOCKET_ERROR) {
	    nmxp_log(1, 0, "Error opening socket!\n");
	    return 1;
	}
235

236
237
238
239
240
	/* DAP Step 2: Read connection time */
	if(nmxp_readConnectionTime(naqssock, &connection_time) != NMXP_SOCKET_OK) {
	    nmxp_log(1, 0, "Error reading connection time from server!\n");
	    return 1;
	}
241

242
243
244
245
246
247
248
249
250
251
252
	/* DAP Step 3: Send a ConnectRequest */
	if(nmxp_sendConnectRequest(naqssock, params.datas_username, params.datas_password, connection_time) != NMXP_SOCKET_OK) {
	    nmxp_log(1, 0, "Error sending connect request!\n");
	    return 1;
	}

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

254
255
256
257
258
259
	exitdapcondition = 1;

	while(exitdapcondition) {

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

260
261
262
	/* Start loop for sending requests */
	i_chan=0;
	request_SOCKET_OK = NMXP_SOCKET_OK;
263

264
	while(request_SOCKET_OK == NMXP_SOCKET_OK  &&  i_chan < channelList_subset->number) {
265

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

269
	    if(request_SOCKET_OK == NMXP_SOCKET_OK) {
270

271
272
273
274
275
		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);

276
277
		if(params.flag_writefile) {
		    /* Open output file */
278
		    sprintf(filename, "%s.%s_%s_%s.nmx",
279
			    CURRENT_NETWORK,
Matteo Quintiliani's avatar
Matteo Quintiliani committed
280
			    channelList_subset->channel[i_chan].name,
281
282
			    str_start_time,
			    str_end_time);
283

284
285
286
287
		    outfile = fopen(filename, "w");
		    if(!outfile) {
			nmxp_log(1, 0, "Can not to open file %s!", filename);
		    }
288
289
290
		}

#ifdef HAVE_LIBMSEED
291
292
		if(params.flag_writeseed) {
		    /* Open output Mini-SEED file */
293
		    sprintf(data_seed.filename_mseed, "%s.%s_%s_%s.miniseed",
294
			    CURRENT_NETWORK,
Matteo Quintiliani's avatar
Matteo Quintiliani committed
295
			    channelList_subset->channel[i_chan].name,
296
297
			    str_start_time,
			    str_end_time);
298

299
300
301
302
303
304
		    data_seed.outfile_mseed = fopen(data_seed.filename_mseed, "w");
		    if(!data_seed.outfile_mseed) {
			nmxp_log(1, 0, "Can not to open file %s!", data_seed.filename_mseed);
		    }
		}
#endif
305

306
307
308
		if(params.flag_writefile  &&  outfile) {
		    /* Compute SNCL line */

309
310
311
312
313
		    /* Separate station_code_old_way and channel_code_old_way */
		    if(nmxp_chan_cpy_sta_chan(channelList_subset->channel[i_chan].name, station_code, channel_code)) {
			/* Write SNCL line */
			fprintf(outfile, "%s.%s.%s.%s\n",
				station_code,
314
				CURRENT_NETWORK,
315
316
				channel_code,
				(params.location)? params.location : "");
317
		    }
318
319
320

		}

321
322
323
		/* DAP Step 6: Receive Data until receiving a Ready message */
		ret = nmxp_receiveMessage(naqssock, &type, &buffer, &length);
		nmxp_log(0, 1, "ret = %d, type = %d\n", ret, type);
324

325
		while(ret == NMXP_SOCKET_OK   &&    type != NMXP_MSG_READY) {
326

327
		    /* Process a packet and return value in NMXP_DATA_PROCESS structure */
328
		    pd = nmxp_processCompressedData(buffer, length, channelList_subset, CURRENT_NETWORK);
Matteo Quintiliani's avatar
Matteo Quintiliani committed
329
		    nmxp_data_trim(pd, params.start_time, params.end_time, 0);
Matteo Quintiliani's avatar
Matteo Quintiliani committed
330
331

		    /* Log contents of last packet */
332
333
334
		    if(params.flag_logdata) {
			nmxp_data_log(pd);
		    }
335

336
		    /* Set cur_chan */
337
		    cur_chan = nmxp_chan_lookupKeyIndex(pd->key, channelList_subset);
338
339

		    /* Management of gaps */
Matteo Quintiliani's avatar
Matteo Quintiliani committed
340
		    if(!channelListSeq[cur_chan].significant && pd->nSamp > 0) {
341
342
			channelListSeq[cur_chan].significant = 1;
		    } else {
Matteo Quintiliani's avatar
Matteo Quintiliani committed
343
			if(channelListSeq[cur_chan].significant) {
344
345
			    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
346
347
				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);
348
			    }
Matteo Quintiliani's avatar
Matteo Quintiliani committed
349
350
			}
		    }
351
		    if(channelListSeq[cur_chan].significant && pd->nSamp > 0) {
Matteo Quintiliani's avatar
Matteo Quintiliani committed
352
			channelListSeq[cur_chan].last_time = pd->time + ((double) pd->nSamp / (double) pd->sampRate);
353
354
		    }

355
#ifdef HAVE_LIBMSEED
356
357
		    /* Write Mini-SEED record */
		    if(params.flag_writeseed) {
358
			nmxptool_write_miniseed(pd);
359
		    }
360
#endif
361

362
#ifdef HAVE___SRC_SEEDLINK_PLUGIN_C
363
		    /* Send data to SeedLink Server */
364
		    if(params.flag_slink) {
365
			nmxptool_send_raw_depoch(pd);
366
		    }
367
368
#endif

369
370
371
		    if(params.flag_writefile  &&  outfile) {
			/* Write buffer to the output file */
			if(outfile && buffer && length > 0) {
372
			    int32_t length_int = length;
373
374
375
376
377
			    nmxp_data_swap_4b((int32_t *) &length_int);
			    fwrite(&length_int, sizeof(length_int), 1, outfile);
			    fwrite(buffer, length, 1, outfile);
			}
		    }
378

Matteo Quintiliani's avatar
Matteo Quintiliani committed
379
380
381
382
383
		    /* 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
384
385
386
		    if(pd->buffer) {
			free(pd->buffer);
			pd->buffer = NULL;
387
		    }
388
389
390
391

		    /* Receive Data */
		    ret = nmxp_receiveMessage(naqssock, &type, &buffer, &length);
		    nmxp_log(0, 1, "ret = %d, type = %d\n", ret, type);
392
393
		}

394
395
396
		if(params.flag_writefile  &&  outfile) {
		    /* Close output file */
		    fclose(outfile);
Matteo Quintiliani's avatar
Matteo Quintiliani committed
397
		    outfile = NULL;
398
399
		}

400
401
402
403
#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
404
		    data_seed.outfile_mseed = NULL;
405
406
		}
#endif
407
408

	    }
409
410
411
	    i_chan++;
	}
	/* DAP Step 7: Repeat steps 5 and 6 for each data request */
412

Matteo Quintiliani's avatar
Matteo Quintiliani committed
413
	if(params.delay > 0) {
Matteo Quintiliani's avatar
Matteo Quintiliani committed
414
415
416
417
418
419
420
	    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 {
		nmxp_log(1, 0, "time to sleep %dsec.\n", time_to_sleep);
		sleep(3);
	    }
Matteo Quintiliani's avatar
Matteo Quintiliani committed
421
422
423
424
425
426
	    params.start_time = params.end_time;
	    params.end_time = params.start_time + span_interval;
	} else {
	    exitdapcondition = 0;
	}

427

Matteo Quintiliani's avatar
Matteo Quintiliani committed
428
    } /* END while(exitdapcondition) */
429

430
431
432
433
434
435
436
437
438
439
440
	/* 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 */
	/* ************************************************************ */


441

Matteo Quintiliani's avatar
Matteo Quintiliani committed
442
    } else {
443

444
	int n_func_pd = 0;
445
	int (*p_func_pd[NMXP_MAX_FUNC_PD]) (NMXP_DATA_PROCESS *);
446
447
448

	if(params.stc == -1) {

449

450
451
452
453
	    if(params.flag_logdata) {
		p_func_pd[n_func_pd++] = nmxptool_print_seq_no;
	    }

454
455
456
457
458
459
460
461
462
463
464
465
466
467
#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
	}
468

469
470
471
472
473
474
475
476
477
	/* ************************************************************* */
	/* 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;
478
479
	}

480
481
482
483
484
485
486
487
488
489
490
491
492
493
494
495
496
	/* 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 */
	channelList_subset = nmxp_chan_subset(channelList, NMXP_DATA_TIMESERIES, params.channels);


	/* PDS Step 4: Send a Request Pending (optional) */
497
498


499
500
501
502
503
504
	/* 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
505
506
507
508
#ifdef HAVE_LIBMSEED
	if(params.flag_writeseed) {
	    /* Open output Mini-SEED file */
	    sprintf(data_seed.filename_mseed, "%s.realtime.miniseed",
509
		    CURRENT_NETWORK);
Matteo Quintiliani's avatar
Matteo Quintiliani committed
510
511
512
513
514
515
516
517
518
519

	    data_seed.outfile_mseed = fopen(data_seed.filename_mseed, "w");
	    if(!data_seed.outfile_mseed) {
		nmxp_log(1, 0, "Can not to open file %s!", data_seed.filename_mseed);
	    } else {
		nmxp_log(0, 1, "Opened file %s!\n", data_seed.filename_mseed);
	    }
	}
#endif

Matteo Quintiliani's avatar
Matteo Quintiliani committed
520
521
522
523
	// TODO
	exitpdscondition = 1;

	while(exitpdscondition) {
524
	    /* Process Compressed or Decompressed Data */
525
	    pd = nmxp_receiveData(naqssock, channelList_subset, CURRENT_NETWORK);
Matteo Quintiliani's avatar
Matteo Quintiliani committed
526
527

	    /* Log contents of last packet */
528
529
530
	    if(params.flag_logdata) {
		nmxp_data_log(pd);
	    }
Matteo Quintiliani's avatar
Matteo Quintiliani committed
531

532
	    /* Set cur_chan */
533
	    cur_chan = nmxp_chan_lookupKeyIndex(pd->key, channelList_subset);
534

535
536
	    /* Manage Raw Stream */
	    if(params.stc == -1) {
537
		nmxp_raw_stream_manage(&(channelListSeq[cur_chan].raw_stream_buffer), pd, p_func_pd, n_func_pd);
538
	    } else {
539
540
541
542
543
544
545
546

		/* 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
547
548
			    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);
549
			}
550
		    }
Matteo Quintiliani's avatar
Matteo Quintiliani committed
551
		}
552
553
554
		if(channelListSeq[cur_chan].significant && pd->nSamp > 0) {
		    channelListSeq[cur_chan].last_time = pd->time + ((double) pd->nSamp / (double) pd->sampRate);
		}
555

Matteo Quintiliani's avatar
Matteo Quintiliani committed
556
557

#ifdef HAVE_LIBMSEED
558
559
560
561
		/* Write Mini-SEED record */
		if(params.flag_writeseed) {
		    nmxptool_write_miniseed(pd);
		}
Matteo Quintiliani's avatar
Matteo Quintiliani committed
562
563
#endif

564
#ifdef HAVE___SRC_SEEDLINK_PLUGIN_C
565
566
567
568
		/* Send data to SeedLink Server */
		if(params.flag_slink) {
		    nmxptool_send_raw_depoch(pd);
		}
569
#endif
570
	    }
571

Matteo Quintiliani's avatar
Matteo Quintiliani committed
572
573
574
575
576
	    /* 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
577
578
579
580
581
	    if(pd->buffer) {
		free(pd->buffer);
		pd->buffer = NULL;
	    }

Matteo Quintiliani's avatar
Matteo Quintiliani committed
582
583
	    // TODO
	    exitpdscondition = 1;
Matteo Quintiliani's avatar
Matteo Quintiliani committed
584
585
586
587
588
589
590
591
592
	}

#ifdef HAVE_LIBMSEED
	if(params.flag_writeseed  &&  data_seed.outfile_mseed) {
	    /* Close output Mini-SEED file */
	    fclose(data_seed.outfile_mseed);
	}
#endif

593
594
595
596
597
598
599
600
601
602
603

	/* 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 */
	/* *********************************************************** */

604
605
606



607
    }
608

609
610
611
612
613
614
615
616
617
618
#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

619
	for(i_chan = 0; i_chan < channelList_subset->number; i_chan++) {
620
	    nmxp_raw_stream_free(&(channelListSeq[i_chan].raw_stream_buffer));
621
622
	}

623
624
625
626
627
628
629
630
631
	if(channelListSeq) {
	    free(channelListSeq);
	}

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

632
633

    return 0;
634
} /* End MAIN */
635
636
637
638
639





Matteo Quintiliani's avatar
Matteo Quintiliani committed
640
641
/* Do any needed cleanup and exit */
static void clientShutdown(int sig) {
642

Matteo Quintiliani's avatar
Matteo Quintiliani committed
643
644
645
646
647
648
649
650
651
652
653
654
655
656
    nmxp_log(0, 0, "Program interrupted!\n");

    if(params.flag_writefile  &&  outfile) {
	/* Close output file */
	fclose(outfile);
    }

#ifdef HAVE_LIBMSEED
    if(params.flag_writeseed  &&  data_seed.outfile_mseed) {
	/* Close output Mini-SEED file */
	fclose(data_seed.outfile_mseed);
    }
#endif

657

Matteo Quintiliani's avatar
Matteo Quintiliani committed
658
659
660
661
662
663
    /* PDS Step 7: Send Terminate Subscription */
    nmxp_sendTerminateSubscription(naqssock, NMXP_SHUTDOWN_NORMAL, "Good Bye!");

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

664

Matteo Quintiliani's avatar
Matteo Quintiliani committed
665
666
667
    if(channelList == NULL) {
	free(channelList);
    }
668

669
670
    int i_chan = 0;

671
672
673
674
675
676
677
678
679
680
#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

681
    for(i_chan = 0; i_chan < channelList_subset->number; i_chan++) {
682
	nmxp_raw_stream_free(&(channelListSeq[i_chan].raw_stream_buffer));
683
684
    }

685
686
687
688
689
    if(channelListSeq) {
	free(channelListSeq);
    }

    /* This has to be the last */
Matteo Quintiliani's avatar
Matteo Quintiliani committed
690
691
692
693
694
695
    if(channelList_subset == NULL) {
	free(channelList_subset);
    }

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

Matteo Quintiliani's avatar
Matteo Quintiliani committed
697
698
699
700

/* Empty signal handler routine */
static void clientDummyHandler(int sig) {
}
Matteo Quintiliani's avatar
Matteo Quintiliani committed
701
702
703
704




705
#ifdef HAVE_LIBMSEED
Matteo Quintiliani's avatar
Matteo Quintiliani committed
706
707
708
709
710
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) {

711
	ret = nmxp_data_msr_pack(pd, &data_seed, msr_list_chan[cur_chan]);
Matteo Quintiliani's avatar
Matteo Quintiliani committed
712
713
714
715
716
717

    } else {
	nmxp_log(1, 0, "Key %d not found in channelList_subset!\n", pd->key);
    }
    return ret;
}
718
#endif
Matteo Quintiliani's avatar
Matteo Quintiliani committed
719

720
721
722
int nmxptool_print_seq_no(NMXP_DATA_PROCESS *pd) {
    int ret = 0;

723
    nmxp_log(NMXP_LOG_NORM_NO, 0, "%s.%s %2d %d %d  lat. %.1fs\n",
Matteo Quintiliani's avatar
Matteo Quintiliani committed
724
725
	    pd->station,
	    pd->channel,
726
727
	    pd->packet_type,
	    pd->seq_no,
728
729
	    pd->oldest_seq_no,
	    nmxp_data_latency(pd)
730
731
732
733
734
	    );

    return ret;
}

735

Matteo Quintiliani's avatar
Matteo Quintiliani committed
736
737
738
739
740
741
742
743
744
745
746
747
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);
}



int nmxptool_check_and_log_gap(double time1, double time2, const double gap_tollerance, const char *station, const char *channel) {
748
749
    char str_time1[200];
    char str_time2[200];
Matteo Quintiliani's avatar
Matteo Quintiliani committed
750
751
    int ret = 0;
    double gap = time1 - time2 ;
752
753
    nmxp_data_to_str(str_time1, time1);
    nmxp_data_to_str(str_time2, time2);
Matteo Quintiliani's avatar
Matteo Quintiliani committed
754
    if(gap > gap_tollerance) {
755
	nmxp_log(1, 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
756
757
	ret = 1;
    } else if (gap < -gap_tollerance) {
758
	nmxp_log(1, 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
759
760
761
762
	ret = 1;
    }
    return ret;
}
763

Matteo Quintiliani's avatar
Matteo Quintiliani committed
764
void nmxptool_str_time_to_filename(char *str_time) {
765
766
767
768
769
770
771
772
773
774
775
776
777
    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] = '.';
	}
    }
}