1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
|
/*
* tsinfo.c - netlink implementation of timestamping commands
*
* Implementation of "ethtool -T <dev>"
*/
#include <errno.h>
#include <string.h>
#include <stdio.h>
#include "../internal.h"
#include "../common.h"
#include "netlink.h"
#include "bitset.h"
/* TSINFO_GET */
static void tsinfo_dump_cb(unsigned int idx, const char *name, bool val,
void *data __maybe_unused)
{
if (!val)
return;
if (name)
printf("\t%s\n", name);
else
printf("\tbit%u\n", idx);
}
static int tsinfo_dump_list(struct nl_context *nlctx, const struct nlattr *attr,
const char *label, const char *if_empty,
unsigned int stringset_id)
{
const struct stringset *strings = NULL;
int ret;
printf("%s:", label);
ret = 0;
if (!attr || bitset_is_empty(attr, false, &ret)) {
printf("%s\n", if_empty);
return ret;
}
putchar('\n');
if (ret < 0)
return ret;
if (bitset_is_compact(attr)) {
ret = netlink_init_ethnl2_socket(nlctx);
if (ret < 0)
return ret;
strings = global_stringset(stringset_id, nlctx->ethnl2_socket);
}
return walk_bitset(attr, strings, tsinfo_dump_cb, NULL);
}
int tsinfo_reply_cb(const struct nlmsghdr *nlhdr, void *data)
{
const struct nlattr *tb[ETHTOOL_A_TSINFO_MAX + 1] = {};
DECLARE_ATTR_TB_INFO(tb);
struct nl_context *nlctx = data;
bool silent;
int err_ret;
int ret;
silent = nlctx->is_dump;
err_ret = silent ? MNL_CB_OK : MNL_CB_ERROR;
ret = mnl_attr_parse(nlhdr, GENL_HDRLEN, attr_cb, &tb_info);
if (ret < 0)
return err_ret;
nlctx->devname = get_dev_name(tb[ETHTOOL_A_TSINFO_HEADER]);
if (!dev_ok(nlctx))
return err_ret;
if (silent)
putchar('\n');
printf("Time stamping parameters for %s:\n", nlctx->devname);
ret = tsinfo_dump_list(nlctx, tb[ETHTOOL_A_TSINFO_TIMESTAMPING],
"Capabilities", "", ETH_SS_SOF_TIMESTAMPING);
if (ret < 0)
return err_ret;
printf("PTP Hardware Clock: ");
if (tb[ETHTOOL_A_TSINFO_PHC_INDEX])
printf("%d\n",
mnl_attr_get_u32(tb[ETHTOOL_A_TSINFO_PHC_INDEX]));
else
printf("none\n");
ret = tsinfo_dump_list(nlctx, tb[ETHTOOL_A_TSINFO_TX_TYPES],
"Hardware Transmit Timestamp Modes", " none",
ETH_SS_TS_TX_TYPES);
if (ret < 0)
return err_ret;
ret = tsinfo_dump_list(nlctx, tb[ETHTOOL_A_TSINFO_RX_FILTERS],
"Hardware Receive Filter Modes", " none",
ETH_SS_TS_RX_FILTERS);
if (ret < 0)
return err_ret;
return MNL_CB_OK;
}
int nl_tsinfo(struct cmd_context *ctx)
{
struct nl_context *nlctx = ctx->nlctx;
struct nl_socket *nlsk = nlctx->ethnl_socket;
int ret;
if (netlink_cmd_check(ctx, ETHTOOL_MSG_TSINFO_GET, true))
return -EOPNOTSUPP;
if (ctx->argc > 0) {
fprintf(stderr, "ethtool: unexpected parameter '%s'\n",
*ctx->argp);
return 1;
}
ret = nlsock_prep_get_request(nlsk, ETHTOOL_MSG_TSINFO_GET,
ETHTOOL_A_TSINFO_HEADER, 0);
if (ret < 0)
return ret;
return nlsock_send_get_request(nlsk, tsinfo_reply_cb);
}
|
