Signed-off-by: Richard Cochran <richardcoch...@gmail.com>
---
msg.h | 12 ++++++++++++
phc2sys.c | 2 +-
pmc_agent.c | 18 +++++-------------
pmc_agent.h | 1 -
4 files changed, 18 insertions(+), 15 deletions(-)
diff --git a/msg.h b/msg.h
index b600ff0..84380da 100644
--- a/msg.h
+++ b/msg.h
@@ -247,6 +247,18 @@ static inline uint8_t management_action(struct ptp_message
*m)
return m->management.flags & 0x0f;
}
+/**
+ * Obtain the data field from the TLV in a management message.
+ * @param m A management message.
+ * @return A pointer to the TLV data field.
+ */
+static inline void *management_tlv_data(struct ptp_message *msg)
+{
+ struct management_tlv *mgt;
+ mgt = (struct management_tlv *) msg->management.suffix;
+ return mgt->data;
+}
+
/**
* Obtain the ID field from the TLV in a management message.
* @param m A management message.
diff --git a/phc2sys.c b/phc2sys.c
index 9c6f2ba..7b488ba 100644
--- a/phc2sys.c
+++ b/phc2sys.c
@@ -813,7 +813,7 @@ static int phc2sys_recv_subscribed(void *context, struct
ptp_message *msg,
return 0;
switch (mgt_id) {
case TLV_PORT_DATA_SET:
- pds = get_mgt_data(msg);
+ pds = management_tlv_data(msg);
port = port_get(priv, pds->portIdentity.portNumber);
if (!port) {
pr_info("received data for unknown port %s",
diff --git a/pmc_agent.c b/pmc_agent.c
index 6dfb3ca..6e9c023 100644
--- a/pmc_agent.c
+++ b/pmc_agent.c
@@ -85,14 +85,6 @@ static int is_msg_mgt(struct ptp_message *msg)
return 0;
}
-void *get_mgt_data(struct ptp_message *msg)
-{
- struct management_tlv *mgt;
-
- mgt = (struct management_tlv *) msg->management.suffix;
- return mgt->data;
-}
-
static int get_mgt_err_id(struct ptp_message *msg)
{
struct management_error_status *mgt;
@@ -188,7 +180,7 @@ int run_pmc_wait_sync(struct pmc_agent *node, int timeout)
if (res <= 0)
return res;
- data = get_mgt_data(msg);
+ data = management_tlv_data(msg);
portState = ((struct portDS *)data)->portState;
msg_put(msg);
@@ -212,7 +204,7 @@ int run_pmc_get_utc_offset(struct pmc_agent *node, int
timeout)
if (res <= 0)
return res;
- tds = (struct timePropertiesDS *)get_mgt_data(msg);
+ tds = (struct timePropertiesDS *) management_tlv_data(msg);
if (tds->flags & PTP_TIMESCALE) {
node->sync_offset = tds->currentUtcOffset;
if (tds->flags & LEAP_61)
@@ -242,7 +234,7 @@ int run_pmc_get_number_ports(struct pmc_agent *node, int
timeout)
if (res <= 0)
return res;
- dds = (struct defaultDS *)get_mgt_data(msg);
+ dds = (struct defaultDS *) management_tlv_data(msg);
res = dds->numberPorts;
msg_put(msg);
return res;
@@ -281,7 +273,7 @@ int run_pmc_port_properties(struct pmc_agent *node, int
timeout,
if (res <= 0)
goto out;
- ppn = get_mgt_data(msg);
+ ppn = management_tlv_data(msg);
if (ppn->portIdentity.portNumber != port) {
msg_put(msg);
continue;
@@ -314,7 +306,7 @@ int run_pmc_clock_identity(struct pmc_agent *node, int
timeout)
if (res <= 0)
return res;
- dds = (struct defaultDS *)get_mgt_data(msg);
+ dds = (struct defaultDS *) management_tlv_data(msg);
memcpy(&node->clock_identity, &dds->clockIdentity,
sizeof(struct ClockIdentity));
node->clock_identity_set = 1;
diff --git a/pmc_agent.h b/pmc_agent.h
index c16a7f2..4cd5b2b 100644
--- a/pmc_agent.h
+++ b/pmc_agent.h
@@ -43,7 +43,6 @@ int run_pmc_port_properties(struct pmc_agent *agent, int
timeout,
unsigned int port, int *state,
int *tstamping, char *iface);
int run_pmc_get_utc_offset(struct pmc_agent *agent, int timeout);
-void *get_mgt_data(struct ptp_message *msg);
/**
--
2.20.1
_______________________________________________
Linuxptp-devel mailing list
Linuxptp-devel@lists.sourceforge.net
https://lists.sourceforge.net/lists/listinfo/linuxptp-devel
