pmc: get CLOCK_DESCRIPTION and USER_DESCRIPTION
Signed-off-by: Geoff Salmon <gsalmon@se-instruments.com>master
Geoff Salmon
Richard Cochran
parent
36a5921e88
commit
e4f1450416
90
pmc.c
90
pmc.c
|
|
@ -24,6 +24,7 @@
|
|||
#include <string.h>
|
||||
#include <unistd.h>
|
||||
#include <inttypes.h>
|
||||
#include <arpa/inet.h>
|
||||
|
||||
#include "ds.h"
|
||||
#include "fsm.h"
|
||||
|
|
@ -53,7 +54,7 @@ struct management_id {
|
|||
|
||||
struct management_id idtab[] = {
|
||||
/* Clock management ID values */
|
||||
{ "USER_DESCRIPTION", USER_DESCRIPTION, not_supported },
|
||||
{ "USER_DESCRIPTION", USER_DESCRIPTION, do_get_action },
|
||||
{ "SAVE_IN_NON_VOLATILE_STORAGE", SAVE_IN_NON_VOLATILE_STORAGE, not_supported },
|
||||
{ "RESET_NON_VOLATILE_STORAGE", RESET_NON_VOLATILE_STORAGE, not_supported },
|
||||
{ "INITIALIZE", INITIALIZE, not_supported },
|
||||
|
|
@ -86,7 +87,7 @@ struct management_id idtab[] = {
|
|||
{ "TIME_STATUS_NP", TIME_STATUS_NP, do_get_action },
|
||||
/* Port management ID values */
|
||||
{ "NULL_MANAGEMENT", NULL_MANAGEMENT, null_management },
|
||||
{ "CLOCK_DESCRIPTION", CLOCK_DESCRIPTION, not_supported },
|
||||
{ "CLOCK_DESCRIPTION", CLOCK_DESCRIPTION, do_get_action },
|
||||
{ "PORT_DATA_SET", PORT_DATA_SET, do_get_action },
|
||||
{ "LOG_ANNOUNCE_INTERVAL", LOG_ANNOUNCE_INTERVAL, not_supported },
|
||||
{ "ANNOUNCE_RECEIPT_TIMEOUT", ANNOUNCE_RECEIPT_TIMEOUT, not_supported },
|
||||
|
|
@ -114,6 +115,61 @@ static char *action_string[] = {
|
|||
|
||||
#define IFMT "\n\t\t"
|
||||
|
||||
static char *text2str(struct PTPText *text) {
|
||||
static struct static_ptp_text s;
|
||||
s.max_symbols = -1;
|
||||
static_ptp_text_copy(&s, text);
|
||||
return (char*)(s.text);
|
||||
}
|
||||
|
||||
#define MAX_PRINT_BYTES 16
|
||||
#define BIN_BUF_SIZE (MAX_PRINT_BYTES * 3 + 1)
|
||||
|
||||
static char *bin2str_impl(Octet *data, int len, char *buf, int buf_len) {
|
||||
int i, offset = 0;
|
||||
if (len > MAX_PRINT_BYTES)
|
||||
len = MAX_PRINT_BYTES;
|
||||
buf[0] = '\0';
|
||||
if (len)
|
||||
offset += snprintf(buf, buf_len, "%02hhx", data[0]);
|
||||
for (i = 1; i < len; i++) {
|
||||
if (offset >= buf_len)
|
||||
/* truncated output */
|
||||
break;
|
||||
offset += snprintf(buf + offset, buf_len - offset, ":%02hhx", data[i]);
|
||||
}
|
||||
return buf;
|
||||
}
|
||||
|
||||
static char *bin2str(Octet *data, int len) {
|
||||
static char buf[BIN_BUF_SIZE];
|
||||
return bin2str_impl(data, len, buf, sizeof(buf));
|
||||
}
|
||||
|
||||
static uint16_t align16(uint16_t *p) {
|
||||
uint16_t v;
|
||||
memcpy(&v, p, sizeof(v));
|
||||
return v;
|
||||
}
|
||||
|
||||
static char *portaddr2str(struct PortAddress *addr) {
|
||||
static char buf[BIN_BUF_SIZE];
|
||||
switch(align16(&addr->networkProtocol)) {
|
||||
case TRANS_UDP_IPV4:
|
||||
if (align16(&addr->addressLength) == 4
|
||||
&& inet_ntop(AF_INET, addr->address, buf, sizeof(buf)))
|
||||
return buf;
|
||||
break;
|
||||
case TRANS_UDP_IPV6:
|
||||
if (align16(&addr->addressLength) == 16
|
||||
&& inet_ntop(AF_INET6, addr->address, buf, sizeof(buf)))
|
||||
return buf;
|
||||
break;
|
||||
}
|
||||
bin2str_impl(addr->address, align16(&addr->addressLength), buf, sizeof(buf));
|
||||
return buf;
|
||||
}
|
||||
|
||||
static void pmc_show(struct ptp_message *msg, FILE *fp)
|
||||
{
|
||||
int action;
|
||||
|
|
@ -124,6 +180,7 @@ static void pmc_show(struct ptp_message *msg, FILE *fp)
|
|||
struct parentDS *pds;
|
||||
struct timePropertiesDS *tp;
|
||||
struct time_status_np *tsn;
|
||||
struct mgmt_clock_description *cd;
|
||||
struct portDS *p;
|
||||
if (msg_type(msg) != MANAGEMENT) {
|
||||
return;
|
||||
|
|
@ -149,6 +206,35 @@ static void pmc_show(struct ptp_message *msg, FILE *fp)
|
|||
}
|
||||
mgt = (struct management_tlv *) msg->management.suffix;
|
||||
switch (mgt->id) {
|
||||
case CLOCK_DESCRIPTION:
|
||||
cd = &msg->last_tlv.cd;
|
||||
fprintf(fp, "CLOCK_DESCRIPTION "
|
||||
IFMT "clockType 0x%hx"
|
||||
IFMT "physicalLayerProtocol %s"
|
||||
IFMT "physicalAddress %s"
|
||||
IFMT "protocolAddress %hu %s",
|
||||
align16(cd->clockType),
|
||||
text2str(cd->physicalLayerProtocol),
|
||||
bin2str(cd->physicalAddress->address,
|
||||
align16(&cd->physicalAddress->length)),
|
||||
align16(&cd->protocolAddress->networkProtocol),
|
||||
portaddr2str(cd->protocolAddress));
|
||||
fprintf(fp, IFMT "manufacturerId %s"
|
||||
IFMT "productDescription %s",
|
||||
bin2str(cd->manufacturerIdentity, OUI_LEN),
|
||||
text2str(cd->productDescription));
|
||||
fprintf(fp, IFMT "revisionData %s",
|
||||
text2str(cd->revisionData));
|
||||
fprintf(fp, IFMT "userDescription %s"
|
||||
IFMT "profileId %s",
|
||||
text2str(cd->userDescription),
|
||||
bin2str(cd->profileIdentity, PROFILE_ID_LEN));
|
||||
break;
|
||||
case USER_DESCRIPTION:
|
||||
fprintf(fp, "USER_DESCRIPTION "
|
||||
IFMT "userDescription %s",
|
||||
text2str(msg->last_tlv.cd.userDescription));
|
||||
break;
|
||||
case DEFAULT_DATA_SET:
|
||||
dds = (struct defaultDS *) mgt->data;
|
||||
fprintf(fp, "DEFAULT_DATA_SET "
|
||||
|
|
|
|||
Loading…
Reference in New Issue