[Linuxptp-devel] [PATCH v2 4/4] ts2phc: reset servo if failed to discipline clock

[Wojtek Wasko via Linuxptp-devel]

Signed-off-by: Wojciech Wasko <wwa...@nvidia.com>
---
 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
Linuxptp-devel@lists.sourceforge.net
https://lists.sourceforge.net/lists/listinfo/linuxptp-devel