Added WR sync monitor app

ff14bdbd · root · 36eab8ff · ff14bdbd
Commit ff14bdbd authored Apr 14, 2011 by root
Hide whitespace changes
Inline Side-by-side

Showing with 86 additions and 0 deletions

monitor.c monitor/monitor.c +86 -0

No files found.
--- a/monitor/monitor.c
+++ b/monitor/monitor.c
+#include "board.h"
+#include "ptpd_exports.h"
+#include "hal_exports.h"
+extern ptpdexp_sync_state_t cur_servo_state;
+#define C_DIM 0x80                                                                                                    
+#define C_WHITE 7
+#define C_GREY (C_WHITE | C_DIM)                                                                                      
+#define C_RED 1
+#define C_GREEN 2                                                                                                     
+#define C_BLUE 4 
+int64_t abs64(int64_t t)
+{
+  return t<0?(-t):t;
+}
+int wr_mon_debug(void)
+{
+  static char* slave_states[] = {"Uninitialized", "SYNC_UTC", "SYNC_NSEC", "SYNC_PHASE", "TRACK_PHASE"};
+  static uint32_t last = 0;
+  hexp_port_state_t ps;
+  if(timer_get_tics() - last < 1000)
+    return 0;
+  last = timer_get_tics();
+  m_term_clear();
+  m_pcprintf(1, 1, C_BLUE, "WR PTP Core Sync Monitor v 0.1");
+  /*show_ports*/
+  halexp_get_port_state(&ps, NULL);
+  m_pcprintf(3, 1, C_BLUE, "Switch ports:");
+  m_pcprintf(5, 1, C_WHITE, "%s: ", "wru1");
+  if(ps.up)  m_cprintf(C_GREEN, "Link up    "); else  m_cprintf(C_RED, "Link down  ");
+  m_cprintf(C_GREY, "mode: ");
+  switch(ps.mode)
+  {   
+    case HEXP_PORT_MODE_WR_MASTER:m_cprintf(C_WHITE, "WR Master  ");break;
+    case HEXP_PORT_MODE_WR_SLAVE:m_cprintf(C_WHITE, "WR Slave   ");break;
+  }   
+  if(ps.is_locked) m_cprintf(C_GREEN, "Locked  "); else   m_cprintf(C_RED, "NoLock  ");
+  if(ps.rx_calibrated  && ps.tx_calibrated) m_cprintf(C_GREEN, "Calibrated  "); else   m_cprintf(C_RED, "Uncalibrated  ");
+  /*show_servo*/
+  m_cprintf(C_BLUE, "\n\nSynchronization status:\n\n");
+  if(!cur_servo_state.valid)
+  {
+    m_cprintf(C_RED, "Master mode or sync info not valid\n\n");
+    return;
+  }   
+  m_cprintf(C_GREY, "Servo state:               "); m_cprintf(C_WHITE, "%s\n", cur_servo_state.slave_servo_state);
+  m_cprintf(C_GREY, "Phase tracking:            "); if(cur_servo_state.tracking_enabled) m_cprintf(C_GREEN, "ON\n"); else m_cprintf(C_RED,"OFF\n");
+  m_cprintf(C_GREY, "Synchronization source:    "); m_cprintf(C_WHITE, "%s\n", cur_servo_state.sync_source);
+  m_cprintf(C_BLUE, "\nTiming parameters:\n\n");
+  m_cprintf(C_GREY, "Round-trip time (mu):      "); m_cprintf(C_WHITE, "%d.%u nsec\n", (int32_t)(cur_servo_state.mu/1000LL), (uint32_t)(cur_servo_state.mu%1000LL));
+  m_cprintf(C_GREY, "Master-slave delay:        "); m_cprintf(C_WHITE, "%d.%u nsec\n", (int32_t)(cur_servo_state.delay_ms/1000LL), (uint32_t)(cur_servo_state.delay_ms%1000LL));
+  //m_cprintf(C_GREY, "Link length:               "); m_cprintf(C_WHITE, "%.0f meters \n", cur_servo_state.delay_ms/193548387096774180864);
+  m_cprintf(C_GREY, "Master PHY delays:         "); m_cprintf(C_WHITE, "TX: %d.%u nsec, RX: %d.%u nsec\n", cur_servo_state.delta_tx_m/1000, cur_servo_state.delta_tx_m%1000, 
+                                                                                                           cur_servo_state.delta_rx_m/1000, cur_servo_state.delta_rx_m%1000);
+  m_cprintf(C_GREY, "Slave PHY delays:          "); m_cprintf(C_WHITE, "TX: %d.%u nsec, RX: %d.%u nsec\n", cur_servo_state.delta_tx_s/1000, cur_servo_state.delta_tx_s%1000,
+                                                                                                           cur_servo_state.delta_rx_s/1000, cur_servo_state.delta_rx_s%1000);
+  m_cprintf(C_GREY, "Total link asymmetry:      "); m_cprintf(C_WHITE, "%d.%u nsec\n", (int32_t)(cur_servo_state.total_asymmetry/1000LL), (int32_t)(abs64(cur_servo_state.total_asymmetry)%1000LL));
+  m_cprintf(C_GREY, "Clock offset:              "); m_cprintf(C_WHITE, "%d.%u nsec\n", (int32_t)(cur_servo_state.cur_offset/1000LL), (int32_t)(abs64(cur_servo_state.cur_offset%1000LL)));
+  m_cprintf(C_GREY, "Phase setpoint:            "); m_cprintf(C_WHITE, "%d.%u nsec\n", (int32_t)(cur_servo_state.cur_setpoint/1000LL), (int32_t)(abs64(cur_servo_state.cur_setpoint%1000LL)));
+  m_cprintf(C_GREY, "Skew:                      "); m_cprintf(C_WHITE, "%d.%u nsec\n", (int32_t)(cur_servo_state.cur_skew/1000LL), (int32_t)(abs64(cur_servo_state.cur_skew%1000LL)));
+  return 0;
+}