1 // SPDX-License-Identifier: GPL-2.0-only
2
3 #include "netlink.h"
4 #include "common.h"
5
6 struct coalesce_req_info {
7 struct ethnl_req_info base;
8 };
9
10 struct coalesce_reply_data {
11 struct ethnl_reply_data base;
12 struct ethtool_coalesce coalesce;
13 u32 supported_params;
14 };
15
16 #define COALESCE_REPDATA(__reply_base) \
17 container_of(__reply_base, struct coalesce_reply_data, base)
18
19 #define __SUPPORTED_OFFSET ETHTOOL_A_COALESCE_RX_USECS
attr_to_mask(unsigned int attr_type)20 static u32 attr_to_mask(unsigned int attr_type)
21 {
22 return BIT(attr_type - __SUPPORTED_OFFSET);
23 }
24
25 /* build time check that indices in ethtool_ops::supported_coalesce_params
26 * match corresponding attribute types with an offset
27 */
28 #define __CHECK_SUPPORTED_OFFSET(x) \
29 static_assert((ETHTOOL_ ## x) == \
30 BIT((ETHTOOL_A_ ## x) - __SUPPORTED_OFFSET))
31 __CHECK_SUPPORTED_OFFSET(COALESCE_RX_USECS);
32 __CHECK_SUPPORTED_OFFSET(COALESCE_RX_MAX_FRAMES);
33 __CHECK_SUPPORTED_OFFSET(COALESCE_RX_USECS_IRQ);
34 __CHECK_SUPPORTED_OFFSET(COALESCE_RX_MAX_FRAMES_IRQ);
35 __CHECK_SUPPORTED_OFFSET(COALESCE_TX_USECS);
36 __CHECK_SUPPORTED_OFFSET(COALESCE_TX_MAX_FRAMES);
37 __CHECK_SUPPORTED_OFFSET(COALESCE_TX_USECS_IRQ);
38 __CHECK_SUPPORTED_OFFSET(COALESCE_TX_MAX_FRAMES_IRQ);
39 __CHECK_SUPPORTED_OFFSET(COALESCE_STATS_BLOCK_USECS);
40 __CHECK_SUPPORTED_OFFSET(COALESCE_USE_ADAPTIVE_RX);
41 __CHECK_SUPPORTED_OFFSET(COALESCE_USE_ADAPTIVE_TX);
42 __CHECK_SUPPORTED_OFFSET(COALESCE_PKT_RATE_LOW);
43 __CHECK_SUPPORTED_OFFSET(COALESCE_RX_USECS_LOW);
44 __CHECK_SUPPORTED_OFFSET(COALESCE_RX_MAX_FRAMES_LOW);
45 __CHECK_SUPPORTED_OFFSET(COALESCE_TX_USECS_LOW);
46 __CHECK_SUPPORTED_OFFSET(COALESCE_TX_MAX_FRAMES_LOW);
47 __CHECK_SUPPORTED_OFFSET(COALESCE_PKT_RATE_HIGH);
48 __CHECK_SUPPORTED_OFFSET(COALESCE_RX_USECS_HIGH);
49 __CHECK_SUPPORTED_OFFSET(COALESCE_RX_MAX_FRAMES_HIGH);
50 __CHECK_SUPPORTED_OFFSET(COALESCE_TX_USECS_HIGH);
51 __CHECK_SUPPORTED_OFFSET(COALESCE_TX_MAX_FRAMES_HIGH);
52 __CHECK_SUPPORTED_OFFSET(COALESCE_RATE_SAMPLE_INTERVAL);
53
54 const struct nla_policy ethnl_coalesce_get_policy[] = {
55 [ETHTOOL_A_COALESCE_HEADER] =
56 NLA_POLICY_NESTED(ethnl_header_policy),
57 };
58
coalesce_prepare_data(const struct ethnl_req_info * req_base,struct ethnl_reply_data * reply_base,struct genl_info * info)59 static int coalesce_prepare_data(const struct ethnl_req_info *req_base,
60 struct ethnl_reply_data *reply_base,
61 struct genl_info *info)
62 {
63 struct coalesce_reply_data *data = COALESCE_REPDATA(reply_base);
64 struct net_device *dev = reply_base->dev;
65 int ret;
66
67 if (!dev->ethtool_ops->get_coalesce)
68 return -EOPNOTSUPP;
69 data->supported_params = dev->ethtool_ops->supported_coalesce_params;
70 ret = ethnl_ops_begin(dev);
71 if (ret < 0)
72 return ret;
73 ret = dev->ethtool_ops->get_coalesce(dev, &data->coalesce);
74 ethnl_ops_complete(dev);
75
76 return ret;
77 }
78
coalesce_reply_size(const struct ethnl_req_info * req_base,const struct ethnl_reply_data * reply_base)79 static int coalesce_reply_size(const struct ethnl_req_info *req_base,
80 const struct ethnl_reply_data *reply_base)
81 {
82 return nla_total_size(sizeof(u32)) + /* _RX_USECS */
83 nla_total_size(sizeof(u32)) + /* _RX_MAX_FRAMES */
84 nla_total_size(sizeof(u32)) + /* _RX_USECS_IRQ */
85 nla_total_size(sizeof(u32)) + /* _RX_MAX_FRAMES_IRQ */
86 nla_total_size(sizeof(u32)) + /* _TX_USECS */
87 nla_total_size(sizeof(u32)) + /* _TX_MAX_FRAMES */
88 nla_total_size(sizeof(u32)) + /* _TX_USECS_IRQ */
89 nla_total_size(sizeof(u32)) + /* _TX_MAX_FRAMES_IRQ */
90 nla_total_size(sizeof(u32)) + /* _STATS_BLOCK_USECS */
91 nla_total_size(sizeof(u8)) + /* _USE_ADAPTIVE_RX */
92 nla_total_size(sizeof(u8)) + /* _USE_ADAPTIVE_TX */
93 nla_total_size(sizeof(u32)) + /* _PKT_RATE_LOW */
94 nla_total_size(sizeof(u32)) + /* _RX_USECS_LOW */
95 nla_total_size(sizeof(u32)) + /* _RX_MAX_FRAMES_LOW */
96 nla_total_size(sizeof(u32)) + /* _TX_USECS_LOW */
97 nla_total_size(sizeof(u32)) + /* _TX_MAX_FRAMES_LOW */
98 nla_total_size(sizeof(u32)) + /* _PKT_RATE_HIGH */
99 nla_total_size(sizeof(u32)) + /* _RX_USECS_HIGH */
100 nla_total_size(sizeof(u32)) + /* _RX_MAX_FRAMES_HIGH */
101 nla_total_size(sizeof(u32)) + /* _TX_USECS_HIGH */
102 nla_total_size(sizeof(u32)) + /* _TX_MAX_FRAMES_HIGH */
103 nla_total_size(sizeof(u32)); /* _RATE_SAMPLE_INTERVAL */
104 }
105
coalesce_put_u32(struct sk_buff * skb,u16 attr_type,u32 val,u32 supported_params)106 static bool coalesce_put_u32(struct sk_buff *skb, u16 attr_type, u32 val,
107 u32 supported_params)
108 {
109 if (!val && !(supported_params & attr_to_mask(attr_type)))
110 return false;
111 return nla_put_u32(skb, attr_type, val);
112 }
113
coalesce_put_bool(struct sk_buff * skb,u16 attr_type,u32 val,u32 supported_params)114 static bool coalesce_put_bool(struct sk_buff *skb, u16 attr_type, u32 val,
115 u32 supported_params)
116 {
117 if (!val && !(supported_params & attr_to_mask(attr_type)))
118 return false;
119 return nla_put_u8(skb, attr_type, !!val);
120 }
121
coalesce_fill_reply(struct sk_buff * skb,const struct ethnl_req_info * req_base,const struct ethnl_reply_data * reply_base)122 static int coalesce_fill_reply(struct sk_buff *skb,
123 const struct ethnl_req_info *req_base,
124 const struct ethnl_reply_data *reply_base)
125 {
126 const struct coalesce_reply_data *data = COALESCE_REPDATA(reply_base);
127 const struct ethtool_coalesce *coal = &data->coalesce;
128 u32 supported = data->supported_params;
129
130 if (coalesce_put_u32(skb, ETHTOOL_A_COALESCE_RX_USECS,
131 coal->rx_coalesce_usecs, supported) ||
132 coalesce_put_u32(skb, ETHTOOL_A_COALESCE_RX_MAX_FRAMES,
133 coal->rx_max_coalesced_frames, supported) ||
134 coalesce_put_u32(skb, ETHTOOL_A_COALESCE_RX_USECS_IRQ,
135 coal->rx_coalesce_usecs_irq, supported) ||
136 coalesce_put_u32(skb, ETHTOOL_A_COALESCE_RX_MAX_FRAMES_IRQ,
137 coal->rx_max_coalesced_frames_irq, supported) ||
138 coalesce_put_u32(skb, ETHTOOL_A_COALESCE_TX_USECS,
139 coal->tx_coalesce_usecs, supported) ||
140 coalesce_put_u32(skb, ETHTOOL_A_COALESCE_TX_MAX_FRAMES,
141 coal->tx_max_coalesced_frames, supported) ||
142 coalesce_put_u32(skb, ETHTOOL_A_COALESCE_TX_USECS_IRQ,
143 coal->tx_coalesce_usecs_irq, supported) ||
144 coalesce_put_u32(skb, ETHTOOL_A_COALESCE_TX_MAX_FRAMES_IRQ,
145 coal->tx_max_coalesced_frames_irq, supported) ||
146 coalesce_put_u32(skb, ETHTOOL_A_COALESCE_STATS_BLOCK_USECS,
147 coal->stats_block_coalesce_usecs, supported) ||
148 coalesce_put_bool(skb, ETHTOOL_A_COALESCE_USE_ADAPTIVE_RX,
149 coal->use_adaptive_rx_coalesce, supported) ||
150 coalesce_put_bool(skb, ETHTOOL_A_COALESCE_USE_ADAPTIVE_TX,
151 coal->use_adaptive_tx_coalesce, supported) ||
152 coalesce_put_u32(skb, ETHTOOL_A_COALESCE_PKT_RATE_LOW,
153 coal->pkt_rate_low, supported) ||
154 coalesce_put_u32(skb, ETHTOOL_A_COALESCE_RX_USECS_LOW,
155 coal->rx_coalesce_usecs_low, supported) ||
156 coalesce_put_u32(skb, ETHTOOL_A_COALESCE_RX_MAX_FRAMES_LOW,
157 coal->rx_max_coalesced_frames_low, supported) ||
158 coalesce_put_u32(skb, ETHTOOL_A_COALESCE_TX_USECS_LOW,
159 coal->tx_coalesce_usecs_low, supported) ||
160 coalesce_put_u32(skb, ETHTOOL_A_COALESCE_TX_MAX_FRAMES_LOW,
161 coal->tx_max_coalesced_frames_low, supported) ||
162 coalesce_put_u32(skb, ETHTOOL_A_COALESCE_PKT_RATE_HIGH,
163 coal->pkt_rate_high, supported) ||
164 coalesce_put_u32(skb, ETHTOOL_A_COALESCE_RX_USECS_HIGH,
165 coal->rx_coalesce_usecs_high, supported) ||
166 coalesce_put_u32(skb, ETHTOOL_A_COALESCE_RX_MAX_FRAMES_HIGH,
167 coal->rx_max_coalesced_frames_high, supported) ||
168 coalesce_put_u32(skb, ETHTOOL_A_COALESCE_TX_USECS_HIGH,
169 coal->tx_coalesce_usecs_high, supported) ||
170 coalesce_put_u32(skb, ETHTOOL_A_COALESCE_TX_MAX_FRAMES_HIGH,
171 coal->tx_max_coalesced_frames_high, supported) ||
172 coalesce_put_u32(skb, ETHTOOL_A_COALESCE_RATE_SAMPLE_INTERVAL,
173 coal->rate_sample_interval, supported))
174 return -EMSGSIZE;
175
176 return 0;
177 }
178
179 const struct ethnl_request_ops ethnl_coalesce_request_ops = {
180 .request_cmd = ETHTOOL_MSG_COALESCE_GET,
181 .reply_cmd = ETHTOOL_MSG_COALESCE_GET_REPLY,
182 .hdr_attr = ETHTOOL_A_COALESCE_HEADER,
183 .req_info_size = sizeof(struct coalesce_req_info),
184 .reply_data_size = sizeof(struct coalesce_reply_data),
185
186 .prepare_data = coalesce_prepare_data,
187 .reply_size = coalesce_reply_size,
188 .fill_reply = coalesce_fill_reply,
189 };
190
191 /* COALESCE_SET */
192
193 const struct nla_policy ethnl_coalesce_set_policy[] = {
194 [ETHTOOL_A_COALESCE_HEADER] =
195 NLA_POLICY_NESTED(ethnl_header_policy),
196 [ETHTOOL_A_COALESCE_RX_USECS] = { .type = NLA_U32 },
197 [ETHTOOL_A_COALESCE_RX_MAX_FRAMES] = { .type = NLA_U32 },
198 [ETHTOOL_A_COALESCE_RX_USECS_IRQ] = { .type = NLA_U32 },
199 [ETHTOOL_A_COALESCE_RX_MAX_FRAMES_IRQ] = { .type = NLA_U32 },
200 [ETHTOOL_A_COALESCE_TX_USECS] = { .type = NLA_U32 },
201 [ETHTOOL_A_COALESCE_TX_MAX_FRAMES] = { .type = NLA_U32 },
202 [ETHTOOL_A_COALESCE_TX_USECS_IRQ] = { .type = NLA_U32 },
203 [ETHTOOL_A_COALESCE_TX_MAX_FRAMES_IRQ] = { .type = NLA_U32 },
204 [ETHTOOL_A_COALESCE_STATS_BLOCK_USECS] = { .type = NLA_U32 },
205 [ETHTOOL_A_COALESCE_USE_ADAPTIVE_RX] = { .type = NLA_U8 },
206 [ETHTOOL_A_COALESCE_USE_ADAPTIVE_TX] = { .type = NLA_U8 },
207 [ETHTOOL_A_COALESCE_PKT_RATE_LOW] = { .type = NLA_U32 },
208 [ETHTOOL_A_COALESCE_RX_USECS_LOW] = { .type = NLA_U32 },
209 [ETHTOOL_A_COALESCE_RX_MAX_FRAMES_LOW] = { .type = NLA_U32 },
210 [ETHTOOL_A_COALESCE_TX_USECS_LOW] = { .type = NLA_U32 },
211 [ETHTOOL_A_COALESCE_TX_MAX_FRAMES_LOW] = { .type = NLA_U32 },
212 [ETHTOOL_A_COALESCE_PKT_RATE_HIGH] = { .type = NLA_U32 },
213 [ETHTOOL_A_COALESCE_RX_USECS_HIGH] = { .type = NLA_U32 },
214 [ETHTOOL_A_COALESCE_RX_MAX_FRAMES_HIGH] = { .type = NLA_U32 },
215 [ETHTOOL_A_COALESCE_TX_USECS_HIGH] = { .type = NLA_U32 },
216 [ETHTOOL_A_COALESCE_TX_MAX_FRAMES_HIGH] = { .type = NLA_U32 },
217 [ETHTOOL_A_COALESCE_RATE_SAMPLE_INTERVAL] = { .type = NLA_U32 },
218 };
219
ethnl_set_coalesce(struct sk_buff * skb,struct genl_info * info)220 int ethnl_set_coalesce(struct sk_buff *skb, struct genl_info *info)
221 {
222 struct ethtool_coalesce coalesce = {};
223 struct ethnl_req_info req_info = {};
224 struct nlattr **tb = info->attrs;
225 const struct ethtool_ops *ops;
226 struct net_device *dev;
227 u32 supported_params;
228 bool mod = false;
229 int ret;
230 u16 a;
231
232 ret = ethnl_parse_header_dev_get(&req_info,
233 tb[ETHTOOL_A_COALESCE_HEADER],
234 genl_info_net(info), info->extack,
235 true);
236 if (ret < 0)
237 return ret;
238 dev = req_info.dev;
239 ops = dev->ethtool_ops;
240 ret = -EOPNOTSUPP;
241 if (!ops->get_coalesce || !ops->set_coalesce)
242 goto out_dev;
243
244 /* make sure that only supported parameters are present */
245 supported_params = ops->supported_coalesce_params;
246 for (a = ETHTOOL_A_COALESCE_RX_USECS; a < __ETHTOOL_A_COALESCE_CNT; a++)
247 if (tb[a] && !(supported_params & attr_to_mask(a))) {
248 ret = -EINVAL;
249 NL_SET_ERR_MSG_ATTR(info->extack, tb[a],
250 "cannot modify an unsupported parameter");
251 goto out_dev;
252 }
253
254 rtnl_lock();
255 ret = ethnl_ops_begin(dev);
256 if (ret < 0)
257 goto out_rtnl;
258 ret = ops->get_coalesce(dev, &coalesce);
259 if (ret < 0)
260 goto out_ops;
261
262 ethnl_update_u32(&coalesce.rx_coalesce_usecs,
263 tb[ETHTOOL_A_COALESCE_RX_USECS], &mod);
264 ethnl_update_u32(&coalesce.rx_max_coalesced_frames,
265 tb[ETHTOOL_A_COALESCE_RX_MAX_FRAMES], &mod);
266 ethnl_update_u32(&coalesce.rx_coalesce_usecs_irq,
267 tb[ETHTOOL_A_COALESCE_RX_USECS_IRQ], &mod);
268 ethnl_update_u32(&coalesce.rx_max_coalesced_frames_irq,
269 tb[ETHTOOL_A_COALESCE_RX_MAX_FRAMES_IRQ], &mod);
270 ethnl_update_u32(&coalesce.tx_coalesce_usecs,
271 tb[ETHTOOL_A_COALESCE_TX_USECS], &mod);
272 ethnl_update_u32(&coalesce.tx_max_coalesced_frames,
273 tb[ETHTOOL_A_COALESCE_TX_MAX_FRAMES], &mod);
274 ethnl_update_u32(&coalesce.tx_coalesce_usecs_irq,
275 tb[ETHTOOL_A_COALESCE_TX_USECS_IRQ], &mod);
276 ethnl_update_u32(&coalesce.tx_max_coalesced_frames_irq,
277 tb[ETHTOOL_A_COALESCE_TX_MAX_FRAMES_IRQ], &mod);
278 ethnl_update_u32(&coalesce.stats_block_coalesce_usecs,
279 tb[ETHTOOL_A_COALESCE_STATS_BLOCK_USECS], &mod);
280 ethnl_update_bool32(&coalesce.use_adaptive_rx_coalesce,
281 tb[ETHTOOL_A_COALESCE_USE_ADAPTIVE_RX], &mod);
282 ethnl_update_bool32(&coalesce.use_adaptive_tx_coalesce,
283 tb[ETHTOOL_A_COALESCE_USE_ADAPTIVE_TX], &mod);
284 ethnl_update_u32(&coalesce.pkt_rate_low,
285 tb[ETHTOOL_A_COALESCE_PKT_RATE_LOW], &mod);
286 ethnl_update_u32(&coalesce.rx_coalesce_usecs_low,
287 tb[ETHTOOL_A_COALESCE_RX_USECS_LOW], &mod);
288 ethnl_update_u32(&coalesce.rx_max_coalesced_frames_low,
289 tb[ETHTOOL_A_COALESCE_RX_MAX_FRAMES_LOW], &mod);
290 ethnl_update_u32(&coalesce.tx_coalesce_usecs_low,
291 tb[ETHTOOL_A_COALESCE_TX_USECS_LOW], &mod);
292 ethnl_update_u32(&coalesce.tx_max_coalesced_frames_low,
293 tb[ETHTOOL_A_COALESCE_TX_MAX_FRAMES_LOW], &mod);
294 ethnl_update_u32(&coalesce.pkt_rate_high,
295 tb[ETHTOOL_A_COALESCE_PKT_RATE_HIGH], &mod);
296 ethnl_update_u32(&coalesce.rx_coalesce_usecs_high,
297 tb[ETHTOOL_A_COALESCE_RX_USECS_HIGH], &mod);
298 ethnl_update_u32(&coalesce.rx_max_coalesced_frames_high,
299 tb[ETHTOOL_A_COALESCE_RX_MAX_FRAMES_HIGH], &mod);
300 ethnl_update_u32(&coalesce.tx_coalesce_usecs_high,
301 tb[ETHTOOL_A_COALESCE_TX_USECS_HIGH], &mod);
302 ethnl_update_u32(&coalesce.tx_max_coalesced_frames_high,
303 tb[ETHTOOL_A_COALESCE_TX_MAX_FRAMES_HIGH], &mod);
304 ethnl_update_u32(&coalesce.rate_sample_interval,
305 tb[ETHTOOL_A_COALESCE_RATE_SAMPLE_INTERVAL], &mod);
306 ret = 0;
307 if (!mod)
308 goto out_ops;
309
310 ret = dev->ethtool_ops->set_coalesce(dev, &coalesce);
311 if (ret < 0)
312 goto out_ops;
313 ethtool_notify(dev, ETHTOOL_MSG_COALESCE_NTF, NULL);
314
315 out_ops:
316 ethnl_ops_complete(dev);
317 out_rtnl:
318 rtnl_unlock();
319 out_dev:
320 dev_put(dev);
321 return ret;
322 }
323