Blame view
net/ethtool/pause.c
4.96 KB
7f59fb32b ethtool: provide ... |
1 2 3 4 5 6 7 8 9 10 11 12 |
// SPDX-License-Identifier: GPL-2.0-only #include "netlink.h" #include "common.h" struct pause_req_info { struct ethnl_req_info base; }; struct pause_reply_data { struct ethnl_reply_data base; struct ethtool_pauseparam pauseparam; |
9a27a3302 ethtool: add stan... |
13 |
struct ethtool_pause_stats pausestat; |
7f59fb32b ethtool: provide ... |
14 15 16 17 |
}; #define PAUSE_REPDATA(__reply_base) \ container_of(__reply_base, struct pause_reply_data, base) |
ff419afa4 ethtool: trim pol... |
18 |
const struct nla_policy ethnl_pause_get_policy[] = { |
329d9c333 ethtool: link up ... |
19 |
[ETHTOOL_A_PAUSE_HEADER] = |
a0de1cd35 ethtool: specify ... |
20 |
NLA_POLICY_NESTED(ethnl_header_policy_stats), |
7f59fb32b ethtool: provide ... |
21 |
}; |
9a27a3302 ethtool: add stan... |
22 23 24 25 26 |
static void ethtool_stats_init(u64 *stats, unsigned int n) { while (n--) stats[n] = ETHTOOL_STAT_NOT_SET; } |
7f59fb32b ethtool: provide ... |
27 28 29 30 31 32 33 34 35 36 |
static int pause_prepare_data(const struct ethnl_req_info *req_base, struct ethnl_reply_data *reply_base, struct genl_info *info) { struct pause_reply_data *data = PAUSE_REPDATA(reply_base); struct net_device *dev = reply_base->dev; int ret; if (!dev->ethtool_ops->get_pauseparam) return -EOPNOTSUPP; |
9a27a3302 ethtool: add stan... |
37 |
|
7f59fb32b ethtool: provide ... |
38 39 40 41 |
ret = ethnl_ops_begin(dev); if (ret < 0) return ret; dev->ethtool_ops->get_pauseparam(dev, &data->pauseparam); |
9a27a3302 ethtool: add stan... |
42 43 44 45 46 47 |
if (req_base->flags & ETHTOOL_FLAG_STATS && dev->ethtool_ops->get_pause_stats) { ethtool_stats_init((u64 *)&data->pausestat, sizeof(data->pausestat) / 8); dev->ethtool_ops->get_pause_stats(dev, &data->pausestat); } |
7f59fb32b ethtool: provide ... |
48 49 50 51 52 53 54 55 |
ethnl_ops_complete(dev); return 0; } static int pause_reply_size(const struct ethnl_req_info *req_base, const struct ethnl_reply_data *reply_base) { |
9a27a3302 ethtool: add stan... |
56 |
int n = nla_total_size(sizeof(u8)) + /* _PAUSE_AUTONEG */ |
7f59fb32b ethtool: provide ... |
57 58 |
nla_total_size(sizeof(u8)) + /* _PAUSE_RX */ nla_total_size(sizeof(u8)); /* _PAUSE_TX */ |
9a27a3302 ethtool: add stan... |
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 |
if (req_base->flags & ETHTOOL_FLAG_STATS) n += nla_total_size(0) + /* _PAUSE_STATS */ nla_total_size_64bit(sizeof(u64)) * (ETHTOOL_A_PAUSE_STAT_MAX - 2); return n; } static int ethtool_put_stat(struct sk_buff *skb, u64 val, u16 attrtype, u16 padtype) { if (val == ETHTOOL_STAT_NOT_SET) return 0; if (nla_put_u64_64bit(skb, attrtype, val, padtype)) return -EMSGSIZE; return 0; } static int pause_put_stats(struct sk_buff *skb, const struct ethtool_pause_stats *pause_stats) { const u16 pad = ETHTOOL_A_PAUSE_STAT_PAD; struct nlattr *nest; nest = nla_nest_start(skb, ETHTOOL_A_PAUSE_STATS); if (!nest) return -EMSGSIZE; if (ethtool_put_stat(skb, pause_stats->tx_pause_frames, ETHTOOL_A_PAUSE_STAT_TX_FRAMES, pad) || ethtool_put_stat(skb, pause_stats->rx_pause_frames, ETHTOOL_A_PAUSE_STAT_RX_FRAMES, pad)) goto err_cancel; nla_nest_end(skb, nest); return 0; err_cancel: nla_nest_cancel(skb, nest); return -EMSGSIZE; |
7f59fb32b ethtool: provide ... |
100 101 102 103 104 105 106 107 108 109 110 111 112 |
} static int pause_fill_reply(struct sk_buff *skb, const struct ethnl_req_info *req_base, const struct ethnl_reply_data *reply_base) { const struct pause_reply_data *data = PAUSE_REPDATA(reply_base); const struct ethtool_pauseparam *pauseparam = &data->pauseparam; if (nla_put_u8(skb, ETHTOOL_A_PAUSE_AUTONEG, !!pauseparam->autoneg) || nla_put_u8(skb, ETHTOOL_A_PAUSE_RX, !!pauseparam->rx_pause) || nla_put_u8(skb, ETHTOOL_A_PAUSE_TX, !!pauseparam->tx_pause)) return -EMSGSIZE; |
9a27a3302 ethtool: add stan... |
113 114 115 |
if (req_base->flags & ETHTOOL_FLAG_STATS && pause_put_stats(skb, &data->pausestat)) return -EMSGSIZE; |
7f59fb32b ethtool: provide ... |
116 117 118 119 120 121 122 |
return 0; } const struct ethnl_request_ops ethnl_pause_request_ops = { .request_cmd = ETHTOOL_MSG_PAUSE_GET, .reply_cmd = ETHTOOL_MSG_PAUSE_GET_REPLY, .hdr_attr = ETHTOOL_A_PAUSE_HEADER, |
7f59fb32b ethtool: provide ... |
123 124 |
.req_info_size = sizeof(struct pause_req_info), .reply_data_size = sizeof(struct pause_reply_data), |
7f59fb32b ethtool: provide ... |
125 126 127 128 129 |
.prepare_data = pause_prepare_data, .reply_size = pause_reply_size, .fill_reply = pause_fill_reply, }; |
3ab879933 ethtool: set paus... |
130 131 |
/* PAUSE_SET */ |
ff419afa4 ethtool: trim pol... |
132 |
const struct nla_policy ethnl_pause_set_policy[] = { |
329d9c333 ethtool: link up ... |
133 134 |
[ETHTOOL_A_PAUSE_HEADER] = NLA_POLICY_NESTED(ethnl_header_policy), |
3ab879933 ethtool: set paus... |
135 136 137 138 139 140 141 |
[ETHTOOL_A_PAUSE_AUTONEG] = { .type = NLA_U8 }, [ETHTOOL_A_PAUSE_RX] = { .type = NLA_U8 }, [ETHTOOL_A_PAUSE_TX] = { .type = NLA_U8 }, }; int ethnl_set_pause(struct sk_buff *skb, struct genl_info *info) { |
3ab879933 ethtool: set paus... |
142 143 |
struct ethtool_pauseparam params = {}; struct ethnl_req_info req_info = {}; |
5028588b6 ethtool: wire up ... |
144 |
struct nlattr **tb = info->attrs; |
3ab879933 ethtool: set paus... |
145 146 147 148 |
const struct ethtool_ops *ops; struct net_device *dev; bool mod = false; int ret; |
3ab879933 ethtool: set paus... |
149 150 151 152 153 154 155 156 157 158 159 160 161 162 163 164 165 166 167 168 169 170 171 172 173 174 |
ret = ethnl_parse_header_dev_get(&req_info, tb[ETHTOOL_A_PAUSE_HEADER], genl_info_net(info), info->extack, true); if (ret < 0) return ret; dev = req_info.dev; ops = dev->ethtool_ops; ret = -EOPNOTSUPP; if (!ops->get_pauseparam || !ops->set_pauseparam) goto out_dev; rtnl_lock(); ret = ethnl_ops_begin(dev); if (ret < 0) goto out_rtnl; ops->get_pauseparam(dev, ¶ms); ethnl_update_bool32(¶ms.autoneg, tb[ETHTOOL_A_PAUSE_AUTONEG], &mod); ethnl_update_bool32(¶ms.rx_pause, tb[ETHTOOL_A_PAUSE_RX], &mod); ethnl_update_bool32(¶ms.tx_pause, tb[ETHTOOL_A_PAUSE_TX], &mod); ret = 0; if (!mod) goto out_ops; ret = dev->ethtool_ops->set_pauseparam(dev, ¶ms); |
bf37faa38 ethtool: add PAUS... |
175 176 177 |
if (ret < 0) goto out_ops; ethtool_notify(dev, ETHTOOL_MSG_PAUSE_NTF, NULL); |
3ab879933 ethtool: set paus... |
178 179 180 181 182 183 184 185 186 |
out_ops: ethnl_ops_complete(dev); out_rtnl: rtnl_unlock(); out_dev: dev_put(dev); return ret; } |