]>
Commit | Line | Data |
---|---|---|
21727545 MK |
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 | |
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 | ||
ff419afa | 54 | const struct nla_policy ethnl_coalesce_get_policy[] = { |
329d9c33 JK |
55 | [ETHTOOL_A_COALESCE_HEADER] = |
56 | NLA_POLICY_NESTED(ethnl_header_policy), | |
21727545 MK |
57 | }; |
58 | ||
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 | ||
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 | ||
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 | ||
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 | ||
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, | |
21727545 MK |
183 | .req_info_size = sizeof(struct coalesce_req_info), |
184 | .reply_data_size = sizeof(struct coalesce_reply_data), | |
21727545 MK |
185 | |
186 | .prepare_data = coalesce_prepare_data, | |
187 | .reply_size = coalesce_reply_size, | |
188 | .fill_reply = coalesce_fill_reply, | |
189 | }; | |
9881418c MK |
190 | |
191 | /* COALESCE_SET */ | |
192 | ||
ff419afa | 193 | const struct nla_policy ethnl_coalesce_set_policy[] = { |
329d9c33 JK |
194 | [ETHTOOL_A_COALESCE_HEADER] = |
195 | NLA_POLICY_NESTED(ethnl_header_policy), | |
9881418c MK |
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 | ||
220 | int ethnl_set_coalesce(struct sk_buff *skb, struct genl_info *info) | |
221 | { | |
9881418c MK |
222 | struct ethtool_coalesce coalesce = {}; |
223 | struct ethnl_req_info req_info = {}; | |
5028588b | 224 | struct nlattr **tb = info->attrs; |
9881418c MK |
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 | ||
9881418c MK |
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); | |
0cf3eac8 MK |
311 | if (ret < 0) |
312 | goto out_ops; | |
313 | ethtool_notify(dev, ETHTOOL_MSG_COALESCE_NTF, NULL); | |
9881418c MK |
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 | } |