From 12ab15818ce8a8f37ac69ac63adca737d7dac6ac Mon Sep 17 00:00:00 2001
From: Richard Cochran <richardcochran@gmail.com>
Date: Sat, 6 Jul 2013 13:04:29 +0200
Subject: [PATCH] Support configuration of the grand master settings.

Signed-off-by: Richard Cochran <richardcochran@gmail.com>
---
 clock.c | 17 +++++++++++++++++
 1 file changed, 17 insertions(+)

diff --git a/clock.c b/clock.c
index ee265ac..c2795a1 100644
--- a/clock.c
+++ b/clock.c
@@ -308,7 +308,24 @@ static int clock_management_set(struct clock *c, struct port *p,
 				int id, struct ptp_message *req)
 {
 	int respond = 0;
+	struct management_tlv *tlv;
+	struct grandmaster_settings_np *gsn;
+
+	tlv = (struct management_tlv *) req->management.suffix;
+
 	switch (id) {
+	case GRANDMASTER_SETTINGS_NP:
+		if (p != c->port[c->nports]) {
+			/* Sorry, only allowed on the UDS port. */
+			break;
+		}
+		gsn = (struct grandmaster_settings_np *) tlv->data;
+		c->dds.clockQuality = gsn->clockQuality;
+		c->utc_offset = gsn->utc_offset;
+		c->time_flags = gsn->time_flags;
+		c->time_source = gsn->time_source;
+		respond = 1;
+		break;
 	}
 	if (respond && !clock_management_get_response(c, p, id, req))
 		pr_err("failed to send management set response");