wr_mon.c

#include <stdio.h>
#include <stdlib.h>

#include <minipc.h>

#include "term.h"

#define PTP_EXPORT_STRUCTURES
#include "ptpd_exports.h"

#include "hal_client.h"

hexp_port_list_t port_list;

static struct minipc_ch *ptp_ch;

void init(int usecolor)
{
	halexp_client_init();

	ptp_ch = minipc_client_create("ptpd", 0);
	if (!ptp_ch)
	{
		fprintf(stderr,"Can't establish WRIPC connection "
			"to the PTP daemon!\n");
		exit(-1);
	}


	term_init(usecolor);
	halexp_query_ports(&port_list);
}

void show_ports()
{
	int i, j;
	time_t t;
	struct tm *tm;
	char datestr[32];

	time(&t);
	tm = localtime(&t);
	strftime(datestr, sizeof(datestr), "%Y-%m-%d %H:%M:%S", tm);
	term_pcprintf(3, 1, C_BLUE, "Switch ports at %s\n", datestr);

	for(i=0; i<18;i++)
	{
		char if_name[10], found = 0;
		hexp_port_state_t state;

		snprintf(if_name, 10, "wr%d", i);
		
		for(j=0;j<port_list.num_ports;j++)
			if(!strcmp(port_list.port_names[j], if_name)) { found = 1; break; }
			
		if(!found) continue;
		
		halexp_get_port_state(&state, if_name);

		term_cprintf(C_WHITE, " %05s: ", if_name);
		if(state.up)
			term_cprintf(C_GREEN, "Link up    ");
		else
			term_cprintf(C_RED, "Link down  ");

		term_cprintf(C_GREY, "mode: ");

		switch(state.mode)
		{
			case HEXP_PORT_MODE_WR_MASTER:
				term_cprintf(C_WHITE, "WR Master  ");
				break;
			case HEXP_PORT_MODE_WR_SLAVE:
				term_cprintf(C_WHITE, "WR Slave   ");
				break;
		}

		if(state.is_locked)
			term_cprintf(C_GREEN, "Locked  ");
		else
			term_cprintf(C_RED, "NoLock  ");

		if(state.rx_calibrated  && state.tx_calibrated)
			term_cprintf(C_GREEN, "Calibrated  \n");
		else
			term_cprintf(C_RED, "Uncalibrated  \n");
	}
}

void show_servo()
{
	ptpdexp_sync_state_t ss;

	minipc_call(ptp_ch, 2000, &__rpcdef_get_sync_state, &ss);

	term_cprintf(C_BLUE, "Synchronization status:\n");

	if(!ss.valid)
	{
		term_cprintf(C_RED, "Master mode or sync info not valid\n");
		return;
	}

	term_cprintf(C_GREY, "Servo state:               ");
	term_cprintf(C_WHITE, "%s\n", ss.slave_servo_state);

	term_cprintf(C_GREY, "Phase tracking:            ");
	if(ss.tracking_enabled)
		term_cprintf(C_GREEN, "ON\n");
	else
		term_cprintf(C_RED,"OFF\n");

	term_cprintf(C_GREY, "Synchronization source:    ");
	term_cprintf(C_WHITE, "%s\n", ss.sync_source);

	term_cprintf(C_BLUE, "\nTiming parameters:\n\n");

	term_cprintf(C_GREY, "Round-trip time (mu):      ");
	term_cprintf(C_WHITE, "%.2f nsec\n", ss.mu/1000.0);

	term_cprintf(C_GREY, "Master-slave delay:        ");
	term_cprintf(C_WHITE, "%.2f nsec\n", ss.delay_ms/1000.0);

	term_cprintf(C_GREY, "Link length:               ");
	term_cprintf(C_WHITE, "%.0f meters \n",
		     ss.delay_ms/1e12 * 300e6 / 1.55);

	term_cprintf(C_GREY, "Master PHY delays:         ");
	term_cprintf(C_WHITE, "TX: %.2f nsec, RX: %.2f nsec\n",
		     ss.delta_tx_m/1000.0, ss.delta_rx_m/1000.0);

	term_cprintf(C_GREY, "Slave PHY delays:          ");
	term_cprintf(C_WHITE, "TX: %.2f nsec, RX: %.2f nsec\n",
		     ss.delta_tx_s/1000.0, ss.delta_rx_s/1000.0);

	term_cprintf(C_GREY, "Total link asymmetry:      ");
	term_cprintf(C_WHITE, "%.2f nsec\n", ss.total_asymmetry/1000.0);

	if (0) {
		term_cprintf(C_GREY, "Fiber asymmetry:           ");
		term_cprintf(C_WHITE, "%.2f nsec\n", ss.fiber_asymmetry/1000.0);
	}

	term_cprintf(C_GREY, "Clock offset:              ");
	term_cprintf(C_WHITE, "%.2f nsec\n", ss.cur_offset/1000.0);

	term_cprintf(C_GREY, "Phase setpoint:            ");
	term_cprintf(C_WHITE, "%.2f nsec\n", ss.cur_setpoint/1000.0);

	term_cprintf(C_GREY, "Skew:                      ");
	term_cprintf(C_WHITE, "%.2f nsec\n", ss.cur_skew/1000.0);

	term_cprintf(C_GREY, "Servo update counter:      ");
	term_cprintf(C_WHITE, "%lld times\n", ss.update_count);
}

int track_onoff = 1;

void show_screen()
{
	term_clear();
	term_pcprintf(1, 1, C_BLUE, "WR Switch Sync Monitor v 1.0 [q = quit]");

	show_ports();
	show_servo();
	fflush(stdout);
}

int main(int argc, char **argv)
{
	int usecolor = 1;

	if (argc > 1 && !strcmp(argv[1], "-b"))
		usecolor = 0;
	init(usecolor);

	setvbuf(stdout, NULL, _IOFBF, 4096);
	for(;;)
	{
		if(term_poll(500))
		{
			int c = term_get();

			if(c=='q')
				break;

			if(c=='t') {
				int rval;
				track_onoff = 1-track_onoff;
				minipc_call(ptp_ch, 200, &__rpcdef_cmd,
					    &rval, PTPDEXP_COMMAND_TRACKING,
					    track_onoff);
			}
		}
		show_screen();
	}
	term_restore();
	setlinebuf(stdout);
	printf("\n");
	return 0;
}