Skip to content

W
White Rabbit Switch - Software
Commit 43ecab79 authored by Alessandro Rubini's avatar Alessandro Rubini
Browse files
Options

userspace/wr_mon: check if wr-servo is updating, and report if not 

Signed-off-by: Alessandro Rubini's avatarAlessandro Rubini <rubini@gnudd.com>
parent 28ea45b5
Hide whitespace changes
Inline Side-by-side
Showing with 15 additions and 5 deletions
userspace/tools/wr_mon.c
View file @ 43ecab79
...@@ -300,6 +300,8 @@ void show_servo(void) ...@@ -300,6 +300,8 @@ void show_servo(void)
{ {
int64_t total_asymmetry; int64_t total_asymmetry;
int64_t crtt; int64_t crtt;
static time_t lastt;
static int last_count;
total_asymmetry = ppsi_servo_local.picos_mu - total_asymmetry = ppsi_servo_local.picos_mu -
2LL * ppsi_servo_local.delta_ms; 2LL * ppsi_servo_local.delta_ms;
...@@ -316,11 +318,15 @@ void show_servo(void) ...@@ -316,11 +318,15 @@ void show_servo(void)
} }
term_cprintf(C_GREY, "Servo state: "); term_cprintf(C_GREY, "Servo state: ");
term_cprintf(C_WHITE, "%s: %s%s\n", if (lastt && time(NULL) - lastt > 5) {
ppsi_servo_local.if_name, term_cprintf(C_RED, " --- not updating --- ");
ppsi_servo_local.servo_state_name, } else {
ppsi_servo_local.flags & WR_FLAG_WAIT_HW ? term_cprintf(C_WHITE, "%s: %s%s\n",
" (wait for hw)" : ""); ppsi_servo_local.if_name,
ppsi_servo_local.servo_state_name,
ppsi_servo_local.flags & WR_FLAG_WAIT_HW ?
" (wait for hw)" : "");
}
/* "tracking disabled" is just a testing tool */ /* "tracking disabled" is just a testing tool */
if (!ppsi_servo_local.tracking_enabled) if (!ppsi_servo_local.tracking_enabled)
...@@ -369,6 +375,10 @@ void show_servo(void) ...@@ -369,6 +375,10 @@ void show_servo(void)
term_cprintf(C_GREY, "Servo update counter: "); term_cprintf(C_GREY, "Servo update counter: ");
term_cprintf(C_WHITE, "%u times\n", term_cprintf(C_WHITE, "%u times\n",
ppsi_servo_local.update_count); ppsi_servo_local.update_count);
if (ppsi_servo_local.update_count != last_count) {
lastt = time(NULL);
last_count = ppsi_servo_local.update_count;
}
} }
else if(mode == SHOW_STATS) { else if(mode == SHOW_STATS) {
printf("SERVO "); printf("SERVO ");
......
Markdown is supported
0% or
You are about to add 0 people to the discussion. Proceed with caution.
Finish editing this message first!
Please register or to comment