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
 *
Matteo Quintiliani's avatar
Matteo Quintiliani committed
10
 * $Id: nmxptool.c,v 1.70 2007-09-28 09:51:25 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
#include "nmxptool_getoptlong.h"
26
#include "nmxptool_ew.h"
27

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

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

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

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

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

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

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

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


60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
/* 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


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

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

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

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

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

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

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

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

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

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

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

151
152
153
154
155
156
157
158
159
160
161
	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
162
163
    } else {
	nmxp_chan_print_channelList(channelList_subset);
Matteo Quintiliani's avatar
Matteo Quintiliani committed
164

165
166
167
168
169
170
171
	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
172
	    channelListSeq[i_chan].x_1 = 0;
173
	    nmxp_raw_stream_init(&(channelListSeq[i_chan].raw_stream_buffer), params.max_tollerable_latency);
174
175
	}

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

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

	    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)) {

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

191
		strcpy(msr_list_chan[i_chan]->network, CURRENT_NETWORK);
192
193
194
195
196
197
198
199
200
201
202
		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
203
204
	}
#endif
205

206
207
208
209
210
211
212
213
    }

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

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

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

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

226

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

231
232
233
234
235
	/* 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;
	}
236

237
238
239
240
241
	/* 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;
	}
242

243
244
245
246
247
248
249
250
251
252
253
	/* 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;
	}
254

255
256
257
258
259
260
	exitdapcondition = 1;

	while(exitdapcondition) {

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

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

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

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

270
	    if(request_SOCKET_OK == NMXP_SOCKET_OK) {
271

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

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

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

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

300
301
302
303
304
305
		    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
306

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

310
311
312
313
314
		    /* 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,
315
				CURRENT_NETWORK,
316
317
				channel_code,
				(params.location)? params.location : "");
318
		    }
319
320
321

		}

322
323
324
		/* 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);
325

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

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

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

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

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

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

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

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

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

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

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

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

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

Matteo Quintiliani's avatar
Matteo Quintiliani committed
414
	if(params.delay > 0) {
Matteo Quintiliani's avatar
Matteo Quintiliani committed
415
416
417
418
419
420
421
	    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
422
423
424
425
426
427
	    params.start_time = params.end_time;
	    params.end_time = params.start_time + span_interval;
	} else {
	    exitdapcondition = 0;
	}

428

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

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


442

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

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

	if(params.stc == -1) {

450

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

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

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

481
482
483
484
485
486
487
488
489
490
491
492
493
494
495
496
497
	/* 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) */
498
499


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

	    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
521
522
523
524
	// TODO
	exitpdscondition = 1;

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

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

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

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

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

Matteo Quintiliani's avatar
Matteo Quintiliani committed
557
558

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

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

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

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

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

594
595
596
597
598
599
600
601
602
603
604

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

605
606
607



608
    }
609

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

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

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

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

633
634

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





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

Matteo Quintiliani's avatar
Matteo Quintiliani committed
644
645
646
647
648
649
650
651
652
653
654
655
656
657
    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

658

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

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

665

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

670
671
    int i_chan = 0;

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

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

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

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

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

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

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




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

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

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

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

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

    return ret;
}

736

Matteo Quintiliani's avatar
Matteo Quintiliani committed
737
738
739
740
741
742
743
744
745
746
747
748
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) {
749
750
    char str_time1[200];
    char str_time2[200];
Matteo Quintiliani's avatar
Matteo Quintiliani committed
751
752
    int ret = 0;
    double gap = time1 - time2 ;
753
754
    nmxp_data_to_str(str_time1, time1);
    nmxp_data_to_str(str_time2, time2);
Matteo Quintiliani's avatar
Matteo Quintiliani committed
755
    if(gap > gap_tollerance) {
756
	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
757
758
	ret = 1;
    } else if (gap < -gap_tollerance) {
759
	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
760
761
762
763
	ret = 1;
    }
    return ret;
}
764

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