Signed-off-by: Wojciech Wasko <[email protected]>
---
ts2phc.c | 17 ++++++++++++++---
1 file changed, 14 insertions(+), 3 deletions(-)
diff --git a/ts2phc.c b/ts2phc.c
index f754234..4393059 100644
--- a/ts2phc.c
+++ b/ts2phc.c
@@ -485,14 +485,25 @@ static void ts2phc_synchronize_clocks(struct
ts2phc_private *priv, int autocfg)
case SERVO_UNLOCKED:
break;
case SERVO_JUMP:
- clockadj_set_freq(c->clkid, -adj);
- clockadj_step(c->clkid, -offset);
+ if (clockadj_set_freq(c->clkid, -adj)) {
+ goto servo_unlock;
+ }
+ if (clockadj_step(c->clkid, -offset)) {
+ goto servo_unlock;
+ }
break;
case SERVO_LOCKED:
case SERVO_LOCKED_STABLE:
- clockadj_set_freq(c->clkid, -adj);
+ if (clockadj_set_freq(c->clkid, -adj)) {
+ goto servo_unlock;
+ }
break;
}
+ continue;
+
+servo_unlock:
+ servo_reset(c->servo);
+ c->servo_state = SERVO_UNLOCKED;
}
}
--
2.25.1
_______________________________________________
Linuxptp-devel mailing list
[email protected]
https://lists.sourceforge.net/lists/listinfo/linuxptp-devel
