1 // SPDX-License-Identifier: GPL-2.0-only 2 3 #include <linux/net_tstamp.h> 4 5 #include "netlink.h" 6 #include "common.h" 7 #include "bitset.h" 8 9 struct tsinfo_req_info { 10 struct ethnl_req_info base; 11 }; 12 13 struct tsinfo_reply_data { 14 struct ethnl_reply_data base; 15 struct ethtool_ts_info ts_info; 16 }; 17 18 #define TSINFO_REPDATA(__reply_base) \ 19 container_of(__reply_base, struct tsinfo_reply_data, base) 20 21 static const struct nla_policy 22 tsinfo_get_policy[ETHTOOL_A_TSINFO_MAX + 1] = { 23 [ETHTOOL_A_TSINFO_UNSPEC] = { .type = NLA_REJECT }, 24 [ETHTOOL_A_TSINFO_HEADER] = { .type = NLA_NESTED }, 25 [ETHTOOL_A_TSINFO_TIMESTAMPING] = { .type = NLA_REJECT }, 26 [ETHTOOL_A_TSINFO_TX_TYPES] = { .type = NLA_REJECT }, 27 [ETHTOOL_A_TSINFO_RX_FILTERS] = { .type = NLA_REJECT }, 28 [ETHTOOL_A_TSINFO_PHC_INDEX] = { .type = NLA_REJECT }, 29 }; 30 31 static int tsinfo_prepare_data(const struct ethnl_req_info *req_base, 32 struct ethnl_reply_data *reply_base, 33 struct genl_info *info) 34 { 35 struct tsinfo_reply_data *data = TSINFO_REPDATA(reply_base); 36 struct net_device *dev = reply_base->dev; 37 int ret; 38 39 ret = ethnl_ops_begin(dev); 40 if (ret < 0) 41 return ret; 42 ret = __ethtool_get_ts_info(dev, &data->ts_info); 43 ethnl_ops_complete(dev); 44 45 return ret; 46 } 47 48 static int tsinfo_reply_size(const struct ethnl_req_info *req_base, 49 const struct ethnl_reply_data *reply_base) 50 { 51 const struct tsinfo_reply_data *data = TSINFO_REPDATA(reply_base); 52 bool compact = req_base->flags & ETHTOOL_FLAG_COMPACT_BITSETS; 53 const struct ethtool_ts_info *ts_info = &data->ts_info; 54 int len = 0; 55 int ret; 56 57 BUILD_BUG_ON(__SOF_TIMESTAMPING_CNT > 32); 58 BUILD_BUG_ON(__HWTSTAMP_TX_CNT > 32); 59 BUILD_BUG_ON(__HWTSTAMP_FILTER_CNT > 32); 60 61 if (ts_info->so_timestamping) { 62 ret = ethnl_bitset32_size(&ts_info->so_timestamping, NULL, 63 __SOF_TIMESTAMPING_CNT, 64 sof_timestamping_names, compact); 65 if (ret < 0) 66 return ret; 67 len += ret; /* _TSINFO_TIMESTAMPING */ 68 } 69 if (ts_info->tx_types) { 70 ret = ethnl_bitset32_size(&ts_info->tx_types, NULL, 71 __HWTSTAMP_TX_CNT, 72 ts_tx_type_names, compact); 73 if (ret < 0) 74 return ret; 75 len += ret; /* _TSINFO_TX_TYPES */ 76 } 77 if (ts_info->rx_filters) { 78 ret = ethnl_bitset32_size(&ts_info->rx_filters, NULL, 79 __HWTSTAMP_FILTER_CNT, 80 ts_rx_filter_names, compact); 81 if (ret < 0) 82 return ret; 83 len += ret; /* _TSINFO_RX_FILTERS */ 84 } 85 if (ts_info->phc_index >= 0) 86 len += nla_total_size(sizeof(u32)); /* _TSINFO_PHC_INDEX */ 87 88 return len; 89 } 90 91 static int tsinfo_fill_reply(struct sk_buff *skb, 92 const struct ethnl_req_info *req_base, 93 const struct ethnl_reply_data *reply_base) 94 { 95 const struct tsinfo_reply_data *data = TSINFO_REPDATA(reply_base); 96 bool compact = req_base->flags & ETHTOOL_FLAG_COMPACT_BITSETS; 97 const struct ethtool_ts_info *ts_info = &data->ts_info; 98 int ret; 99 100 if (ts_info->so_timestamping) { 101 ret = ethnl_put_bitset32(skb, ETHTOOL_A_TSINFO_TIMESTAMPING, 102 &ts_info->so_timestamping, NULL, 103 __SOF_TIMESTAMPING_CNT, 104 sof_timestamping_names, compact); 105 if (ret < 0) 106 return ret; 107 } 108 if (ts_info->tx_types) { 109 ret = ethnl_put_bitset32(skb, ETHTOOL_A_TSINFO_TX_TYPES, 110 &ts_info->tx_types, NULL, 111 __HWTSTAMP_TX_CNT, 112 ts_tx_type_names, compact); 113 if (ret < 0) 114 return ret; 115 } 116 if (ts_info->rx_filters) { 117 ret = ethnl_put_bitset32(skb, ETHTOOL_A_TSINFO_RX_FILTERS, 118 &ts_info->rx_filters, NULL, 119 __HWTSTAMP_FILTER_CNT, 120 ts_rx_filter_names, compact); 121 if (ret < 0) 122 return ret; 123 } 124 if (ts_info->phc_index >= 0 && 125 nla_put_u32(skb, ETHTOOL_A_TSINFO_PHC_INDEX, ts_info->phc_index)) 126 return -EMSGSIZE; 127 128 return 0; 129 } 130 131 const struct ethnl_request_ops ethnl_tsinfo_request_ops = { 132 .request_cmd = ETHTOOL_MSG_TSINFO_GET, 133 .reply_cmd = ETHTOOL_MSG_TSINFO_GET_REPLY, 134 .hdr_attr = ETHTOOL_A_TSINFO_HEADER, 135 .max_attr = ETHTOOL_A_TSINFO_MAX, 136 .req_info_size = sizeof(struct tsinfo_req_info), 137 .reply_data_size = sizeof(struct tsinfo_reply_data), 138 .request_policy = tsinfo_get_policy, 139 140 .prepare_data = tsinfo_prepare_data, 141 .reply_size = tsinfo_reply_size, 142 .fill_reply = tsinfo_fill_reply, 143 }; 144