nmxptool.c 23.7 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.84 2007-10-07 18:12:37 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);

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

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

64
int nmxptool_print_seq_no(NMXP_DATA_PROCESS *pd);
Matteo Quintiliani's avatar
Matteo Quintiliani committed
65
66

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
67
void nmxptool_str_time_to_filename(char *str_time);
Matteo Quintiliani's avatar
Matteo Quintiliani committed
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;
75
NMXP_CHAN_LIST_NET *channelList_subset = NULL;
76
77
78
79
80
81
82
83
84
NMXPTOOL_CHAN_SEQ *channelListSeq = NULL;

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


85
int main (int argc, char **argv) {
86
    int32_t connection_time;
87
    int request_SOCKET_OK;
Matteo Quintiliani's avatar
Matteo Quintiliani committed
88
    int i_chan, cur_chan = 0;
Matteo Quintiliani's avatar
Matteo Quintiliani committed
89
    int to_cur_chan = 0;
Matteo Quintiliani's avatar
Matteo Quintiliani committed
90
    int exitpdscondition;
Matteo Quintiliani's avatar
Matteo Quintiliani committed
91
    int exitdapcondition;
Matteo Quintiliani's avatar
Matteo Quintiliani committed
92
    time_t timeout_for_channel;
Matteo Quintiliani's avatar
Matteo Quintiliani committed
93

Matteo Quintiliani's avatar
Matteo Quintiliani committed
94
    int span_interval = 10;
Matteo Quintiliani's avatar
Matteo Quintiliani committed
95
96
    int time_to_sleep = 0;

97
98
    char str_start_time[200];
    char str_end_time[200];
Matteo Quintiliani's avatar
Matteo Quintiliani committed
99
    char str_pd_time[200];
100
101
102

    NMXP_MSG_SERVER type;
    void *buffer;
103
    int32_t length;
104
105
    int ret;

Matteo Quintiliani's avatar
Matteo Quintiliani committed
106
107
    int recv_errno = 0;

108
    char filename[500];
109
    char station_code[20], channel_code[20], network_code[20];
110
111
112
113
114
115
116
117

    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
118
119
120
121
122
123
124
125
#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);
126

Matteo Quintiliani's avatar
Matteo Quintiliani committed
127
128
129
130
131
132
133
134
135
136
137
    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 */
138
139
140
141
142
143
144
    nmxp_log(-1, 0);

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

145
    if(params.ew_configuration_file) {
Matteo Quintiliani's avatar
Matteo Quintiliani committed
146
147
148
149
150
151
152

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

156
    } else {
Matteo Quintiliani's avatar
Matteo Quintiliani committed
157

Matteo Quintiliani's avatar
Matteo Quintiliani committed
158
159
	nmxp_log_init(nmxp_log_stdout, nmxp_log_stderr);

160
161
162
163
164
	/* Check consistency of params */
	if(nmxptool_check_params(&params) != 0) {
	    return 1;
	}

165
166
167
	if(params.flag_verbose) {
	    nmxp_log(-1, 2);
	}
168

169
170
	/* List available channels on server */
	if(params.flag_listchannels) {
171

172
173
174
175
	    // TOREMOVE
	    // channelList = nmxp_getAvailableChannelList(params.hostname, params.portnumberpds, NMXP_DATA_TIMESERIES);
	    // TOREMOVE
	    // nmxp_chan_print_channelList(channelList);
176

177
	    nmxp_getMetaChannelList(params.hostname, params.portnumberdap, NMXP_DATA_TIMESERIES, params.flag_request_channelinfo);
178

179
180
181
	    return 1;
	}
    }
182

183
184
    /* Get list of available channels and get a subset list of params.channels */
    channelList = nmxp_getAvailableChannelList(params.hostname, params.portnumberpds, NMXP_DATA_TIMESERIES);
185
    channelList_subset = nmxp_chan_subset(channelList, NMXP_DATA_TIMESERIES, params.channels, CURRENT_NETWORK);
186
187
188
189
190

    /* 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
191
192
    } else {
	nmxp_chan_print_channelList(channelList_subset);
Matteo Quintiliani's avatar
Matteo Quintiliani committed
193

194
195
196
197
198
199
200
	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
201
	    channelListSeq[i_chan].last_time_call_raw_stream = 0;
Matteo Quintiliani's avatar
Matteo Quintiliani committed
202
	    channelListSeq[i_chan].x_1 = 0;
Matteo Quintiliani's avatar
Matteo Quintiliani committed
203
	    nmxp_raw_stream_init(&(channelListSeq[i_chan].raw_stream_buffer), params.max_tolerable_latency, params.timeoutrecv);
204
205
	}

Matteo Quintiliani's avatar
Matteo Quintiliani committed
206
#ifdef HAVE_LIBMSEED
207
208
209
	nmxp_log(0, 1, "Init mini-SEED record list.\n");

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

	    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 */
217
	    if(nmxp_chan_cpy_sta_chan(channelList_subset->channel[i_chan].name, station_code, channel_code, network_code)) {
218

219
		nmxp_log(0, 1, "%s.%s.%s\n", NETCODE_OR_CURRENT_NETWORK, station_code, channel_code);
220

221
		strcpy(msr_list_chan[i_chan]->network, NETCODE_OR_CURRENT_NETWORK);
222
223
224
225
226
227
228
229
230
231
232
		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
233
234
	}
#endif
235

236
237
238
239
240
241
242
243
    }

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

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

246
    /* TODO condition starting DAP or PDS */
247
248
249
    if( (params.start_time != 0   &&   params.end_time != 0)
	    || params.delay > 0
	    ) {
250

Matteo Quintiliani's avatar
Matteo Quintiliani committed
251
	if(params.delay > 0) {
Matteo Quintiliani's avatar
Matteo Quintiliani committed
252
	    params.start_time = ((time(NULL) - params.delay - span_interval) / 10) * 10;
Matteo Quintiliani's avatar
Matteo Quintiliani committed
253
254
255
	    params.end_time = params.start_time + span_interval;
	}

256

257
258
259
	/* ************************************************************** */
	/* Start subscription protocol "DATA ACCESS PROTOCOL" version 1.0 */
	/* ************************************************************** */
260

261
262
263
264
265
	/* 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;
	}
266

267
268
269
270
271
	/* 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;
	}
272

273
274
275
276
277
278
279
280
281
282
283
	/* 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;
	}
284

285
286
287
288
289
290
	exitdapcondition = 1;

	while(exitdapcondition) {

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

291
292
293
	/* Start loop for sending requests */
	i_chan=0;
	request_SOCKET_OK = NMXP_SOCKET_OK;
294

295
	while(request_SOCKET_OK == NMXP_SOCKET_OK  &&  i_chan < channelList_subset->number) {
296

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

300
	    if(request_SOCKET_OK == NMXP_SOCKET_OK) {
301

302
303
304
305
306
		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);

307
308
		if(params.flag_writefile) {
		    /* Open output file */
309
310
311
312
313
314
315
316
317
318
319
320
321
		    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);
		    }
322

323
324
325
326
		    outfile = fopen(filename, "w");
		    if(!outfile) {
			nmxp_log(1, 0, "Can not to open file %s!", filename);
		    }
327
328
329
		}

#ifdef HAVE_LIBMSEED
330
331
		if(params.flag_writeseed) {
		    /* Open output Mini-SEED file */
332
333
334
335
336
337
338
339
340
341
342
343
344
		    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);
		    }
345

346
347
348
349
350
351
		    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
352

353
354
355
		if(params.flag_writefile  &&  outfile) {
		    /* Compute SNCL line */

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

		}

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

372
		while(ret == NMXP_SOCKET_OK   &&    type != NMXP_MSG_READY) {
373

374
		    /* Process a packet and return value in NMXP_DATA_PROCESS structure */
375
		    pd = nmxp_processCompressedData(buffer, length, channelList_subset, NETCODE_OR_CURRENT_NETWORK);
Matteo Quintiliani's avatar
Matteo Quintiliani committed
376
		    nmxp_data_trim(pd, params.start_time, params.end_time, 0);
Matteo Quintiliani's avatar
Matteo Quintiliani committed
377
378

		    /* Log contents of last packet */
379
380
381
		    if(params.flag_logdata) {
			nmxp_data_log(pd);
		    }
382

383
		    /* Set cur_chan */
384
		    cur_chan = nmxp_chan_lookupKeyIndex(pd->key, channelList_subset);
385
386

		    /* Management of gaps */
Matteo Quintiliani's avatar
Matteo Quintiliani committed
387
		    if(!channelListSeq[cur_chan].significant && pd->nSamp > 0) {
388
389
			channelListSeq[cur_chan].significant = 1;
		    } else {
Matteo Quintiliani's avatar
Matteo Quintiliani committed
390
			if(channelListSeq[cur_chan].significant) {
391
392
			    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
393
394
				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);
395
			    }
Matteo Quintiliani's avatar
Matteo Quintiliani committed
396
397
			}
		    }
398
		    if(channelListSeq[cur_chan].significant && pd->nSamp > 0) {
Matteo Quintiliani's avatar
Matteo Quintiliani committed
399
			channelListSeq[cur_chan].last_time = pd->time + ((double) pd->nSamp / (double) pd->sampRate);
400
401
		    }

402
#ifdef HAVE_LIBMSEED
403
404
		    /* Write Mini-SEED record */
		    if(params.flag_writeseed) {
405
			nmxptool_write_miniseed(pd);
406
		    }
407
#endif
408

409
#ifdef HAVE___SRC_SEEDLINK_PLUGIN_C
410
		    /* Send data to SeedLink Server */
411
		    if(params.flag_slink) {
412
			nmxptool_send_raw_depoch(pd);
413
		    }
414
415
#endif

416
417
418
		    if(params.flag_writefile  &&  outfile) {
			/* Write buffer to the output file */
			if(outfile && buffer && length > 0) {
419
			    int32_t length_int = length;
420
421
422
423
424
			    nmxp_data_swap_4b((int32_t *) &length_int);
			    fwrite(&length_int, sizeof(length_int), 1, outfile);
			    fwrite(buffer, length, 1, outfile);
			}
		    }
425

Matteo Quintiliani's avatar
Matteo Quintiliani committed
426
427
428
429
430
		    /* 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
431
432
433
		    if(pd->buffer) {
			free(pd->buffer);
			pd->buffer = NULL;
434
		    }
435
436

		    /* Receive Data */
Matteo Quintiliani's avatar
Matteo Quintiliani committed
437
		    ret = nmxp_receiveMessage(naqssock, &type, &buffer, &length, 0, &recv_errno);
438
		    nmxp_log(0, 1, "ret = %d, type = %d\n", ret, type);
439
440
		}

441
442
443
		if(params.flag_writefile  &&  outfile) {
		    /* Close output file */
		    fclose(outfile);
Matteo Quintiliani's avatar
Matteo Quintiliani committed
444
		    outfile = NULL;
445
446
		}

447
448
449
450
#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
451
		    data_seed.outfile_mseed = NULL;
452
453
		}
#endif
454
455

	    }
456
457
458
	    i_chan++;
	}
	/* DAP Step 7: Repeat steps 5 and 6 for each data request */
459

Matteo Quintiliani's avatar
Matteo Quintiliani committed
460
	if(params.delay > 0) {
Matteo Quintiliani's avatar
Matteo Quintiliani committed
461
462
463
464
465
466
467
	    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
468
469
470
471
472
473
	    params.start_time = params.end_time;
	    params.end_time = params.start_time + span_interval;
	} else {
	    exitdapcondition = 0;
	}

474

Matteo Quintiliani's avatar
Matteo Quintiliani committed
475
    } /* END while(exitdapcondition) */
476

477
478
479
480
481
482
483
484
485
486
487
	/* 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 */
	/* ************************************************************ */


488

Matteo Quintiliani's avatar
Matteo Quintiliani committed
489
    } else {
490

491
	int n_func_pd = 0;
492
	int (*p_func_pd[NMXP_MAX_FUNC_PD]) (NMXP_DATA_PROCESS *);
493
494
495

	if(params.stc == -1) {

496

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

501
502
503
504
505
506
507
508
509
510
511
512
513
#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
514
515
516
517
518
519
520

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

521
	}
522

523
524
525
526
527
528
529
530
531
	/* ************************************************************* */
	/* 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;
532
533
	}

534
535
536
537
538
539
540
541
542
543
544
545
546
	/* 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 */
547
	channelList_subset = nmxp_chan_subset(channelList, NMXP_DATA_TIMESERIES, params.channels, CURRENT_NETWORK);
548
549
550


	/* PDS Step 4: Send a Request Pending (optional) */
551
552


553
554
555
556
557
558
	/* 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
559
560
561
562
#ifdef HAVE_LIBMSEED
	if(params.flag_writeseed) {
	    /* Open output Mini-SEED file */
	    sprintf(data_seed.filename_mseed, "%s.realtime.miniseed",
563
		    CURRENT_NETWORK);
Matteo Quintiliani's avatar
Matteo Quintiliani committed
564
565
566
567
568
569
570
571
572
573

	    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
574
575
576
	// TODO
	exitpdscondition = 1;

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

583
	
Matteo Quintiliani's avatar
Matteo Quintiliani committed
584
	while(exitpdscondition) {
Matteo Quintiliani's avatar
Matteo Quintiliani committed
585

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

	    /* Log contents of last packet */
590
591
592
	    if(params.flag_logdata) {
		nmxp_data_log(pd);
	    }
Matteo Quintiliani's avatar
Matteo Quintiliani committed
593

Matteo Quintiliani's avatar
Matteo Quintiliani committed
594
	    if(pd) {
Matteo Quintiliani's avatar
Matteo Quintiliani committed
595
596
		/* Set cur_chan */
		cur_chan = nmxp_chan_lookupKeyIndex(pd->key, channelList_subset);
Matteo Quintiliani's avatar
Matteo Quintiliani committed
597
	    }
598

599
600
	    /* Manage Raw Stream */
	    if(params.stc == -1) {
Matteo Quintiliani's avatar
Matteo Quintiliani committed
601
602
603
604
605
606
607
608
609
610
611
612
613
614
615
616
617
618
619
620
621
622
623

		/* 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) {
		    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++;
		    }
		}

624
	    } else {
625

Matteo Quintiliani's avatar
Matteo Quintiliani committed
626
	    if(pd) {
627
628
629
630
631
632
633
		/* 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
634
635
			    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);
636
			}
637
		    }
Matteo Quintiliani's avatar
Matteo Quintiliani committed
638
		}
639
640
641
		if(channelListSeq[cur_chan].significant && pd->nSamp > 0) {
		    channelListSeq[cur_chan].last_time = pd->time + ((double) pd->nSamp / (double) pd->sampRate);
		}
642

Matteo Quintiliani's avatar
Matteo Quintiliani committed
643
644

#ifdef HAVE_LIBMSEED
645
646
647
648
		/* Write Mini-SEED record */
		if(params.flag_writeseed) {
		    nmxptool_write_miniseed(pd);
		}
Matteo Quintiliani's avatar
Matteo Quintiliani committed
649
650
#endif

651
#ifdef HAVE___SRC_SEEDLINK_PLUGIN_C
652
653
654
655
		/* Send data to SeedLink Server */
		if(params.flag_slink) {
		    nmxptool_send_raw_depoch(pd);
		}
656
#endif
657
	    }
Matteo Quintiliani's avatar
Matteo Quintiliani committed
658
	    }
659

Matteo Quintiliani's avatar
Matteo Quintiliani committed
660
	    if(pd) {
Matteo Quintiliani's avatar
Matteo Quintiliani committed
661
662
663
664
665
	    /* 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
666
667
668
669
	    if(pd->buffer) {
		free(pd->buffer);
		pd->buffer = NULL;
	    }
Matteo Quintiliani's avatar
Matteo Quintiliani committed
670
	    }
Matteo Quintiliani's avatar
Matteo Quintiliani committed
671

Matteo Quintiliani's avatar
Matteo Quintiliani committed
672
673
	    // TODO
	    exitpdscondition = 1;
Matteo Quintiliani's avatar
Matteo Quintiliani committed
674
675
676
677
678
679
680
681
682
683
684
685
686
687
688
689

#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
690
691
	}

Matteo Quintiliani's avatar
Matteo Quintiliani committed
692
693
694
695
696
697
#ifdef HAVE_EARTHWORMOBJS
	if(params.ew_configuration_file) {
	    nmxptool_ew_detach();
	}
#endif

Matteo Quintiliani's avatar
Matteo Quintiliani committed
698
699
700
701
702
703
704
#ifdef HAVE_LIBMSEED
	if(params.flag_writeseed  &&  data_seed.outfile_mseed) {
	    /* Close output Mini-SEED file */
	    fclose(data_seed.outfile_mseed);
	}
#endif

705
706
707
708
709
710
711
712
713
714
715

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

716
717


718
    }
719

720
721
722
723
724
725
726
727
728
729
#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

730
	for(i_chan = 0; i_chan < channelList_subset->number; i_chan++) {
731
	    nmxp_raw_stream_free(&(channelListSeq[i_chan].raw_stream_buffer));
732
733
	}

734
735
736
737
738
739
740
741
742
	if(channelListSeq) {
	    free(channelListSeq);
	}

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

743
    return 0;
744
} /* End MAIN */
745
746
747
748
749





Matteo Quintiliani's avatar
Matteo Quintiliani committed
750
751
/* Do any needed cleanup and exit */
static void clientShutdown(int sig) {
752

Matteo Quintiliani's avatar
Matteo Quintiliani committed
753
754
755
756
757
758
759
    nmxp_log(0, 0, "Program interrupted!\n");

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

760
761
762
763
764
765
#ifdef HAVE_EARTHWORMOBJS
	if(params.ew_configuration_file) {
	    nmxptool_ew_detach();
	}
#endif

Matteo Quintiliani's avatar
Matteo Quintiliani committed
766
767
768
769
770
771
772
#ifdef HAVE_LIBMSEED
    if(params.flag_writeseed  &&  data_seed.outfile_mseed) {
	/* Close output Mini-SEED file */
	fclose(data_seed.outfile_mseed);
    }
#endif

773

Matteo Quintiliani's avatar
Matteo Quintiliani committed
774
775
776
777
778
779
    /* PDS Step 7: Send Terminate Subscription */
    nmxp_sendTerminateSubscription(naqssock, NMXP_SHUTDOWN_NORMAL, "Good Bye!");

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

780

Matteo Quintiliani's avatar
Matteo Quintiliani committed
781
782
783
    if(channelList == NULL) {
	free(channelList);
    }
784

785
786
    int i_chan = 0;

787
788
789
790
791
792
793
794
795
796
#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

797
    for(i_chan = 0; i_chan < channelList_subset->number; i_chan++) {
798
	nmxp_raw_stream_free(&(channelListSeq[i_chan].raw_stream_buffer));
799
800
    }

801
802
803
804
805
    if(channelListSeq) {
	free(channelListSeq);
    }

    /* This has to be the last */
Matteo Quintiliani's avatar
Matteo Quintiliani committed
806
807
808
809
810
811
    if(channelList_subset == NULL) {
	free(channelList_subset);
    }

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

Matteo Quintiliani's avatar
Matteo Quintiliani committed
813
814
815
816

/* Empty signal handler routine */
static void clientDummyHandler(int sig) {
}
Matteo Quintiliani's avatar
Matteo Quintiliani committed
817
818
819
820




821
#ifdef HAVE_LIBMSEED
Matteo Quintiliani's avatar
Matteo Quintiliani committed
822
823
824
825
826
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) {

827
	ret = nmxp_data_msr_pack(pd, &data_seed, msr_list_chan[cur_chan]);
Matteo Quintiliani's avatar
Matteo Quintiliani committed
828
829
830
831
832
833

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

836
837
int nmxptool_print_seq_no(NMXP_DATA_PROCESS *pd) {
    int ret = 0;
Matteo Quintiliani's avatar
Matteo Quintiliani committed
838
839
    char str_time[200];
    nmxp_data_to_str(str_time, pd->time);
840

Matteo Quintiliani's avatar
Matteo Quintiliani committed
841
842
    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
843
844
	    pd->station,
	    pd->channel,
845
846
	    pd->packet_type,
	    pd->seq_no,
847
	    pd->oldest_seq_no,
Matteo Quintiliani's avatar
Matteo Quintiliani committed
848
849
	    str_time,
	    pd->nSamp,
850
	    nmxp_data_latency(pd)
851
852
853
854
855
	    );

    return ret;
}

856

Matteo Quintiliani's avatar
Matteo Quintiliani committed
857
#ifdef HAVE___SRC_SEEDLINK_PLUGIN_C
Matteo Quintiliani's avatar
Matteo Quintiliani committed
858
859
860
861
862
863
864
865
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
866
#endif
Matteo Quintiliani's avatar
Matteo Quintiliani committed
867
868
869
870



int nmxptool_check_and_log_gap(double time1, double time2, const double gap_tollerance, const char *station, const char *channel) {
871
872
    char str_time1[200];
    char str_time2[200];
Matteo Quintiliani's avatar
Matteo Quintiliani committed
873
874
    int ret = 0;
    double gap = time1 - time2 ;
875
876
    nmxp_data_to_str(str_time1, time1);
    nmxp_data_to_str(str_time2, time2);
Matteo Quintiliani's avatar
Matteo Quintiliani committed
877
    if(gap > gap_tollerance) {
878
	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
879
880
	ret = 1;
    } else if (gap < -gap_tollerance) {
881
	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
882
883
884
885
	ret = 1;
    }
    return ret;
}
886

Matteo Quintiliani's avatar
Matteo Quintiliani committed
887
void nmxptool_str_time_to_filename(char *str_time) {
888
889
890
891
892
893
894
895
896
897
898
899
900
    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] = '.';
	}
    }
}