Eric Lee / smarc-fsl-linux-kernel

Blame view

net/ethtool/linkmodes.c 13.7 KB
edit raw normal view history
f625aa9be   Michal Kubecek   ethtool: provide ... 
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
 
  // SPDX-License-Identifier: GPL-2.0-only
  
  #include "netlink.h"
  #include "common.h"
  #include "bitset.h"
  
  struct linkmodes_req_info {
  	struct ethnl_req_info		base;
  };
  
  struct linkmodes_reply_data {
  	struct ethnl_reply_data		base;
  	struct ethtool_link_ksettings	ksettings;
  	struct ethtool_link_settings	*lsettings;
  	bool				peer_empty;
  };
  
  #define LINKMODES_REPDATA(__reply_base) \
  	container_of(__reply_base, struct linkmodes_reply_data, base)
ff419afa4   Jakub Kicinski   ethtool: trim pol... 
20
 
  const struct nla_policy ethnl_linkmodes_get_policy[] = {
329d9c333   Jakub Kicinski   ethtool: link up ... 
21
22
 
  	[ETHTOOL_A_LINKMODES_HEADER]		=
  		NLA_POLICY_NESTED(ethnl_header_policy),
f625aa9be   Michal Kubecek   ethtool: provide ... 
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
 
  };
  
  static int linkmodes_prepare_data(const struct ethnl_req_info *req_base,
  				  struct ethnl_reply_data *reply_base,
  				  struct genl_info *info)
  {
  	struct linkmodes_reply_data *data = LINKMODES_REPDATA(reply_base);
  	struct net_device *dev = reply_base->dev;
  	int ret;
  
  	data->lsettings = &data->ksettings.base;
  
  	ret = ethnl_ops_begin(dev);
  	if (ret < 0)
  		return ret;
  
  	ret = __ethtool_get_link_ksettings(dev, &data->ksettings);
  	if (ret < 0 && info) {
  		GENL_SET_ERR_MSG(info, "failed to retrieve link settings");
  		goto out;
  	}
  
  	data->peer_empty =
  		bitmap_empty(data->ksettings.link_modes.lp_advertising,
  			     __ETHTOOL_LINK_MODE_MASK_NBITS);
  
  out:
  	ethnl_ops_complete(dev);
  	return ret;
  }
  
  static int linkmodes_reply_size(const struct ethnl_req_info *req_base,
  				const struct ethnl_reply_data *reply_base)
  {
  	const struct linkmodes_reply_data *data = LINKMODES_REPDATA(reply_base);
  	const struct ethtool_link_ksettings *ksettings = &data->ksettings;
bdbdac764   Oleksij Rempel   ethtool: provide ... 
59
 
  	const struct ethtool_link_settings *lsettings = &ksettings->base;
f625aa9be   Michal Kubecek   ethtool: provide ... 
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
 
  	bool compact = req_base->flags & ETHTOOL_FLAG_COMPACT_BITSETS;
  	int len, ret;
  
  	len = nla_total_size(sizeof(u8)) /* LINKMODES_AUTONEG */
  		+ nla_total_size(sizeof(u32)) /* LINKMODES_SPEED */
  		+ nla_total_size(sizeof(u8)) /* LINKMODES_DUPLEX */
  		+ 0;
  	ret = ethnl_bitset_size(ksettings->link_modes.advertising,
  				ksettings->link_modes.supported,
  				__ETHTOOL_LINK_MODE_MASK_NBITS,
  				link_mode_names, compact);
  	if (ret < 0)
  		return ret;
  	len += ret;
  	if (!data->peer_empty) {
  		ret = ethnl_bitset_size(ksettings->link_modes.lp_advertising,
  					NULL, __ETHTOOL_LINK_MODE_MASK_NBITS,
  					link_mode_names, compact);
  		if (ret < 0)
  			return ret;
  		len += ret;
  	}
bdbdac764   Oleksij Rempel   ethtool: provide ... 
82
83
84
85
86
 
  	if (lsettings->master_slave_cfg != MASTER_SLAVE_CFG_UNSUPPORTED)
  		len += nla_total_size(sizeof(u8));
  
  	if (lsettings->master_slave_state != MASTER_SLAVE_STATE_UNSUPPORTED)
  		len += nla_total_size(sizeof(u8));
f625aa9be   Michal Kubecek   ethtool: provide ... 
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
 
  	return len;
  }
  
  static int linkmodes_fill_reply(struct sk_buff *skb,
  				const struct ethnl_req_info *req_base,
  				const struct ethnl_reply_data *reply_base)
  {
  	const struct linkmodes_reply_data *data = LINKMODES_REPDATA(reply_base);
  	const struct ethtool_link_ksettings *ksettings = &data->ksettings;
  	const struct ethtool_link_settings *lsettings = &ksettings->base;
  	bool compact = req_base->flags & ETHTOOL_FLAG_COMPACT_BITSETS;
  	int ret;
  
  	if (nla_put_u8(skb, ETHTOOL_A_LINKMODES_AUTONEG, lsettings->autoneg))
  		return -EMSGSIZE;
  
  	ret = ethnl_put_bitset(skb, ETHTOOL_A_LINKMODES_OURS,
  			       ksettings->link_modes.advertising,
  			       ksettings->link_modes.supported,
  			       __ETHTOOL_LINK_MODE_MASK_NBITS, link_mode_names,
  			       compact);
  	if (ret < 0)
  		return -EMSGSIZE;
  	if (!data->peer_empty) {
  		ret = ethnl_put_bitset(skb, ETHTOOL_A_LINKMODES_PEER,
  				       ksettings->link_modes.lp_advertising,
  				       NULL, __ETHTOOL_LINK_MODE_MASK_NBITS,
  				       link_mode_names, compact);
  		if (ret < 0)
  			return -EMSGSIZE;
  	}
  
  	if (nla_put_u32(skb, ETHTOOL_A_LINKMODES_SPEED, lsettings->speed) ||
  	    nla_put_u8(skb, ETHTOOL_A_LINKMODES_DUPLEX, lsettings->duplex))
  		return -EMSGSIZE;
bdbdac764   Oleksij Rempel   ethtool: provide ... 
122
123
124
125
126
127
128
129
130
 
  	if (lsettings->master_slave_cfg != MASTER_SLAVE_CFG_UNSUPPORTED &&
  	    nla_put_u8(skb, ETHTOOL_A_LINKMODES_MASTER_SLAVE_CFG,
  		       lsettings->master_slave_cfg))
  		return -EMSGSIZE;
  
  	if (lsettings->master_slave_state != MASTER_SLAVE_STATE_UNSUPPORTED &&
  	    nla_put_u8(skb, ETHTOOL_A_LINKMODES_MASTER_SLAVE_STATE,
  		       lsettings->master_slave_state))
  		return -EMSGSIZE;
f625aa9be   Michal Kubecek   ethtool: provide ... 
131
132
133
134
135
136
137
 
  	return 0;
  }
  
  const struct ethnl_request_ops ethnl_linkmodes_request_ops = {
  	.request_cmd		= ETHTOOL_MSG_LINKMODES_GET,
  	.reply_cmd		= ETHTOOL_MSG_LINKMODES_GET_REPLY,
  	.hdr_attr		= ETHTOOL_A_LINKMODES_HEADER,
f625aa9be   Michal Kubecek   ethtool: provide ... 
138
139
 
  	.req_info_size		= sizeof(struct linkmodes_req_info),
  	.reply_data_size	= sizeof(struct linkmodes_reply_data),
f625aa9be   Michal Kubecek   ethtool: provide ... 
140
141
142
143
144
 
  
  	.prepare_data		= linkmodes_prepare_data,
  	.reply_size		= linkmodes_reply_size,
  	.fill_reply		= linkmodes_fill_reply,
  };
bfbcfe203   Michal Kubecek   ethtool: set link... 
145
146
147
148
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
175
176
177
178
179
180
181
182
183
184
185
186
187
188
189
190
191
192
193
194
195
196
197
198
199
200
201
202
203
204
205
206
207
208
209
210
211
212
213
214
215
216
217
218
219
220
221
222
223
224
225
226
227
228
229
230
231
232
233
234
235
236
237
238
239
240
241
242
243
 
  
  /* LINKMODES_SET */
  
  struct link_mode_info {
  	int				speed;
  	u8				duplex;
  };
  
  #define __DEFINE_LINK_MODE_PARAMS(_speed, _type, _duplex) \
  	[ETHTOOL_LINK_MODE(_speed, _type, _duplex)] = { \
  		.speed	= SPEED_ ## _speed, \
  		.duplex	= __DUPLEX_ ## _duplex \
  	}
  #define __DUPLEX_Half DUPLEX_HALF
  #define __DUPLEX_Full DUPLEX_FULL
  #define __DEFINE_SPECIAL_MODE_PARAMS(_mode) \
  	[ETHTOOL_LINK_MODE_ ## _mode ## _BIT] = { \
  		.speed	= SPEED_UNKNOWN, \
  		.duplex	= DUPLEX_UNKNOWN, \
  	}
  
  static const struct link_mode_info link_mode_params[] = {
  	__DEFINE_LINK_MODE_PARAMS(10, T, Half),
  	__DEFINE_LINK_MODE_PARAMS(10, T, Full),
  	__DEFINE_LINK_MODE_PARAMS(100, T, Half),
  	__DEFINE_LINK_MODE_PARAMS(100, T, Full),
  	__DEFINE_LINK_MODE_PARAMS(1000, T, Half),
  	__DEFINE_LINK_MODE_PARAMS(1000, T, Full),
  	__DEFINE_SPECIAL_MODE_PARAMS(Autoneg),
  	__DEFINE_SPECIAL_MODE_PARAMS(TP),
  	__DEFINE_SPECIAL_MODE_PARAMS(AUI),
  	__DEFINE_SPECIAL_MODE_PARAMS(MII),
  	__DEFINE_SPECIAL_MODE_PARAMS(FIBRE),
  	__DEFINE_SPECIAL_MODE_PARAMS(BNC),
  	__DEFINE_LINK_MODE_PARAMS(10000, T, Full),
  	__DEFINE_SPECIAL_MODE_PARAMS(Pause),
  	__DEFINE_SPECIAL_MODE_PARAMS(Asym_Pause),
  	__DEFINE_LINK_MODE_PARAMS(2500, X, Full),
  	__DEFINE_SPECIAL_MODE_PARAMS(Backplane),
  	__DEFINE_LINK_MODE_PARAMS(1000, KX, Full),
  	__DEFINE_LINK_MODE_PARAMS(10000, KX4, Full),
  	__DEFINE_LINK_MODE_PARAMS(10000, KR, Full),
  	[ETHTOOL_LINK_MODE_10000baseR_FEC_BIT] = {
  		.speed	= SPEED_10000,
  		.duplex = DUPLEX_FULL,
  	},
  	__DEFINE_LINK_MODE_PARAMS(20000, MLD2, Full),
  	__DEFINE_LINK_MODE_PARAMS(20000, KR2, Full),
  	__DEFINE_LINK_MODE_PARAMS(40000, KR4, Full),
  	__DEFINE_LINK_MODE_PARAMS(40000, CR4, Full),
  	__DEFINE_LINK_MODE_PARAMS(40000, SR4, Full),
  	__DEFINE_LINK_MODE_PARAMS(40000, LR4, Full),
  	__DEFINE_LINK_MODE_PARAMS(56000, KR4, Full),
  	__DEFINE_LINK_MODE_PARAMS(56000, CR4, Full),
  	__DEFINE_LINK_MODE_PARAMS(56000, SR4, Full),
  	__DEFINE_LINK_MODE_PARAMS(56000, LR4, Full),
  	__DEFINE_LINK_MODE_PARAMS(25000, CR, Full),
  	__DEFINE_LINK_MODE_PARAMS(25000, KR, Full),
  	__DEFINE_LINK_MODE_PARAMS(25000, SR, Full),
  	__DEFINE_LINK_MODE_PARAMS(50000, CR2, Full),
  	__DEFINE_LINK_MODE_PARAMS(50000, KR2, Full),
  	__DEFINE_LINK_MODE_PARAMS(100000, KR4, Full),
  	__DEFINE_LINK_MODE_PARAMS(100000, SR4, Full),
  	__DEFINE_LINK_MODE_PARAMS(100000, CR4, Full),
  	__DEFINE_LINK_MODE_PARAMS(100000, LR4_ER4, Full),
  	__DEFINE_LINK_MODE_PARAMS(50000, SR2, Full),
  	__DEFINE_LINK_MODE_PARAMS(1000, X, Full),
  	__DEFINE_LINK_MODE_PARAMS(10000, CR, Full),
  	__DEFINE_LINK_MODE_PARAMS(10000, SR, Full),
  	__DEFINE_LINK_MODE_PARAMS(10000, LR, Full),
  	__DEFINE_LINK_MODE_PARAMS(10000, LRM, Full),
  	__DEFINE_LINK_MODE_PARAMS(10000, ER, Full),
  	__DEFINE_LINK_MODE_PARAMS(2500, T, Full),
  	__DEFINE_LINK_MODE_PARAMS(5000, T, Full),
  	__DEFINE_SPECIAL_MODE_PARAMS(FEC_NONE),
  	__DEFINE_SPECIAL_MODE_PARAMS(FEC_RS),
  	__DEFINE_SPECIAL_MODE_PARAMS(FEC_BASER),
  	__DEFINE_LINK_MODE_PARAMS(50000, KR, Full),
  	__DEFINE_LINK_MODE_PARAMS(50000, SR, Full),
  	__DEFINE_LINK_MODE_PARAMS(50000, CR, Full),
  	__DEFINE_LINK_MODE_PARAMS(50000, LR_ER_FR, Full),
  	__DEFINE_LINK_MODE_PARAMS(50000, DR, Full),
  	__DEFINE_LINK_MODE_PARAMS(100000, KR2, Full),
  	__DEFINE_LINK_MODE_PARAMS(100000, SR2, Full),
  	__DEFINE_LINK_MODE_PARAMS(100000, CR2, Full),
  	__DEFINE_LINK_MODE_PARAMS(100000, LR2_ER2_FR2, Full),
  	__DEFINE_LINK_MODE_PARAMS(100000, DR2, Full),
  	__DEFINE_LINK_MODE_PARAMS(200000, KR4, Full),
  	__DEFINE_LINK_MODE_PARAMS(200000, SR4, Full),
  	__DEFINE_LINK_MODE_PARAMS(200000, LR4_ER4_FR4, Full),
  	__DEFINE_LINK_MODE_PARAMS(200000, DR4, Full),
  	__DEFINE_LINK_MODE_PARAMS(200000, CR4, Full),
  	__DEFINE_LINK_MODE_PARAMS(100, T1, Full),
  	__DEFINE_LINK_MODE_PARAMS(1000, T1, Full),
  	__DEFINE_LINK_MODE_PARAMS(400000, KR8, Full),
  	__DEFINE_LINK_MODE_PARAMS(400000, SR8, Full),
  	__DEFINE_LINK_MODE_PARAMS(400000, LR8_ER8_FR8, Full),
  	__DEFINE_LINK_MODE_PARAMS(400000, DR8, Full),
  	__DEFINE_LINK_MODE_PARAMS(400000, CR8, Full),
f623e5970   Aya Levin   ethtool: Add supp... 
244
 
  	__DEFINE_SPECIAL_MODE_PARAMS(FEC_LLRS),
065e0d42a   Meir Lichtinger   ethtool: Add supp... 
245
246
247
248
249
250
251
252
253
254
255
256
257
258
259
 
  	__DEFINE_LINK_MODE_PARAMS(100000, KR, Full),
  	__DEFINE_LINK_MODE_PARAMS(100000, SR, Full),
  	__DEFINE_LINK_MODE_PARAMS(100000, LR_ER_FR, Full),
  	__DEFINE_LINK_MODE_PARAMS(100000, DR, Full),
  	__DEFINE_LINK_MODE_PARAMS(100000, CR, Full),
  	__DEFINE_LINK_MODE_PARAMS(200000, KR2, Full),
  	__DEFINE_LINK_MODE_PARAMS(200000, SR2, Full),
  	__DEFINE_LINK_MODE_PARAMS(200000, LR2_ER2_FR2, Full),
  	__DEFINE_LINK_MODE_PARAMS(200000, DR2, Full),
  	__DEFINE_LINK_MODE_PARAMS(200000, CR2, Full),
  	__DEFINE_LINK_MODE_PARAMS(400000, KR4, Full),
  	__DEFINE_LINK_MODE_PARAMS(400000, SR4, Full),
  	__DEFINE_LINK_MODE_PARAMS(400000, LR4_ER4_FR4, Full),
  	__DEFINE_LINK_MODE_PARAMS(400000, DR4, Full),
  	__DEFINE_LINK_MODE_PARAMS(400000, CR4, Full),
55f133117   Dan Murphy   ethtool: Add 100b... 
260
261
 
  	__DEFINE_LINK_MODE_PARAMS(100, FX, Half),
  	__DEFINE_LINK_MODE_PARAMS(100, FX, Full),
bfbcfe203   Michal Kubecek   ethtool: set link... 
262
 
  };
ff419afa4   Jakub Kicinski   ethtool: trim pol... 
263
 
  const struct nla_policy ethnl_linkmodes_set_policy[] = {
329d9c333   Jakub Kicinski   ethtool: link up ... 
264
265
 
  	[ETHTOOL_A_LINKMODES_HEADER]		=
  		NLA_POLICY_NESTED(ethnl_header_policy),
bfbcfe203   Michal Kubecek   ethtool: set link... 
266
267
 
  	[ETHTOOL_A_LINKMODES_AUTONEG]		= { .type = NLA_U8 },
  	[ETHTOOL_A_LINKMODES_OURS]		= { .type = NLA_NESTED },
bfbcfe203   Michal Kubecek   ethtool: set link... 
268
269
 
  	[ETHTOOL_A_LINKMODES_SPEED]		= { .type = NLA_U32 },
  	[ETHTOOL_A_LINKMODES_DUPLEX]		= { .type = NLA_U8 },
bdbdac764   Oleksij Rempel   ethtool: provide ... 
270
 
  	[ETHTOOL_A_LINKMODES_MASTER_SLAVE_CFG]	= { .type = NLA_U8 },
bfbcfe203   Michal Kubecek   ethtool: set link... 
271
272
273
274
275
276
277
278
279
280
281
282
283
284
285
286
287
288
289
290
291
292
293
294
295
296
297
298
299
300
301
302
303
304
305
306
307
 
  };
  
  /* Set advertised link modes to all supported modes matching requested speed
   * and duplex values. Called when autonegotiation is on, speed or duplex is
   * requested but no link mode change. This is done in userspace with ioctl()
   * interface, move it into kernel for netlink.
   * Returns true if advertised modes bitmap was modified.
   */
  static bool ethnl_auto_linkmodes(struct ethtool_link_ksettings *ksettings,
  				 bool req_speed, bool req_duplex)
  {
  	unsigned long *advertising = ksettings->link_modes.advertising;
  	unsigned long *supported = ksettings->link_modes.supported;
  	DECLARE_BITMAP(old_adv, __ETHTOOL_LINK_MODE_MASK_NBITS);
  	unsigned int i;
  
  	BUILD_BUG_ON(ARRAY_SIZE(link_mode_params) !=
  		     __ETHTOOL_LINK_MODE_MASK_NBITS);
  
  	bitmap_copy(old_adv, advertising, __ETHTOOL_LINK_MODE_MASK_NBITS);
  
  	for (i = 0; i < __ETHTOOL_LINK_MODE_MASK_NBITS; i++) {
  		const struct link_mode_info *info = &link_mode_params[i];
  
  		if (info->speed == SPEED_UNKNOWN)
  			continue;
  		if (test_bit(i, supported) &&
  		    (!req_speed || info->speed == ksettings->base.speed) &&
  		    (!req_duplex || info->duplex == ksettings->base.duplex))
  			set_bit(i, advertising);
  		else
  			clear_bit(i, advertising);
  	}
  
  	return !bitmap_equal(old_adv, advertising,
  			     __ETHTOOL_LINK_MODE_MASK_NBITS);
  }
bdbdac764   Oleksij Rempel   ethtool: provide ... 
308
309
310
311
312
313
314
315
316
317
318
319
 
  static bool ethnl_validate_master_slave_cfg(u8 cfg)
  {
  	switch (cfg) {
  	case MASTER_SLAVE_CFG_MASTER_PREFERRED:
  	case MASTER_SLAVE_CFG_SLAVE_PREFERRED:
  	case MASTER_SLAVE_CFG_MASTER_FORCE:
  	case MASTER_SLAVE_CFG_SLAVE_FORCE:
  		return true;
  	}
  
  	return false;
  }
bfbcfe203   Michal Kubecek   ethtool: set link... 
320
321
322
323
324
325
 
  static int ethnl_update_linkmodes(struct genl_info *info, struct nlattr **tb,
  				  struct ethtool_link_ksettings *ksettings,
  				  bool *mod)
  {
  	struct ethtool_link_settings *lsettings = &ksettings->base;
  	bool req_speed, req_duplex;
bdbdac764   Oleksij Rempel   ethtool: provide ... 
326
 
  	const struct nlattr *master_slave_cfg;
bfbcfe203   Michal Kubecek   ethtool: set link... 
327
 
  	int ret;
bdbdac764   Oleksij Rempel   ethtool: provide ... 
328
329
330
331
332
333
334
335
336
337
338
339
340
341
342
343
 
  	master_slave_cfg = tb[ETHTOOL_A_LINKMODES_MASTER_SLAVE_CFG];
  	if (master_slave_cfg) {
  		u8 cfg = nla_get_u8(master_slave_cfg);
  
  		if (lsettings->master_slave_cfg == MASTER_SLAVE_CFG_UNSUPPORTED) {
  			NL_SET_ERR_MSG_ATTR(info->extack, master_slave_cfg,
  					    "master/slave configuration not supported by device");
  			return -EOPNOTSUPP;
  		}
  
  		if (!ethnl_validate_master_slave_cfg(cfg)) {
  			NL_SET_ERR_MSG_ATTR(info->extack, master_slave_cfg,
  					    "master/slave value is invalid");
  			return -EOPNOTSUPP;
  		}
  	}
bfbcfe203   Michal Kubecek   ethtool: set link... 
344
345
346
347
348
349
350
351
352
353
354
355
356
357
358
359
 
  	*mod = false;
  	req_speed = tb[ETHTOOL_A_LINKMODES_SPEED];
  	req_duplex = tb[ETHTOOL_A_LINKMODES_DUPLEX];
  
  	ethnl_update_u8(&lsettings->autoneg, tb[ETHTOOL_A_LINKMODES_AUTONEG],
  			mod);
  	ret = ethnl_update_bitset(ksettings->link_modes.advertising,
  				  __ETHTOOL_LINK_MODE_MASK_NBITS,
  				  tb[ETHTOOL_A_LINKMODES_OURS], link_mode_names,
  				  info->extack, mod);
  	if (ret < 0)
  		return ret;
  	ethnl_update_u32(&lsettings->speed, tb[ETHTOOL_A_LINKMODES_SPEED],
  			 mod);
  	ethnl_update_u8(&lsettings->duplex, tb[ETHTOOL_A_LINKMODES_DUPLEX],
  			mod);
bdbdac764   Oleksij Rempel   ethtool: provide ... 
360
 
  	ethnl_update_u8(&lsettings->master_slave_cfg, master_slave_cfg, mod);
bfbcfe203   Michal Kubecek   ethtool: set link... 
361
362
363
364
365
366
367
368
369
370
371
 
  
  	if (!tb[ETHTOOL_A_LINKMODES_OURS] && lsettings->autoneg &&
  	    (req_speed || req_duplex) &&
  	    ethnl_auto_linkmodes(ksettings, req_speed, req_duplex))
  		*mod = true;
  
  	return 0;
  }
  
  int ethnl_set_linkmodes(struct sk_buff *skb, struct genl_info *info)
  {
bfbcfe203   Michal Kubecek   ethtool: set link... 
372
 
  	struct ethtool_link_ksettings ksettings = {};
bfbcfe203   Michal Kubecek   ethtool: set link... 
373
 
  	struct ethnl_req_info req_info = {};
5028588b6   Jakub Kicinski   ethtool: wire up ... 
374
 
  	struct nlattr **tb = info->attrs;
bfbcfe203   Michal Kubecek   ethtool: set link... 
375
376
377
 
  	struct net_device *dev;
  	bool mod = false;
  	int ret;
98130546d   Michal Kubecek   ethtool: rename e... 
378
379
380
381
 
  	ret = ethnl_parse_header_dev_get(&req_info,
  					 tb[ETHTOOL_A_LINKMODES_HEADER],
  					 genl_info_net(info), info->extack,
  					 true);
bfbcfe203   Michal Kubecek   ethtool: set link... 
382
383
384
 
  	if (ret < 0)
  		return ret;
  	dev = req_info.dev;
2f599ec42   Michal Kubecek   ethtool: fix refe... 
385
 
  	ret = -EOPNOTSUPP;
bfbcfe203   Michal Kubecek   ethtool: set link... 
386
387
 
  	if (!dev->ethtool_ops->get_link_ksettings ||
  	    !dev->ethtool_ops->set_link_ksettings)
2f599ec42   Michal Kubecek   ethtool: fix refe... 
388
 
  		goto out_dev;
bfbcfe203   Michal Kubecek   ethtool: set link... 
389
390
391
392
393
394
395
396
 
  
  	rtnl_lock();
  	ret = ethnl_ops_begin(dev);
  	if (ret < 0)
  		goto out_rtnl;
  
  	ret = __ethtool_get_link_ksettings(dev, &ksettings);
  	if (ret < 0) {
71fed0bc8   Gaurav Singh   ethtool: ethnl_se... 
397
 
  		GENL_SET_ERR_MSG(info, "failed to retrieve link settings");
bfbcfe203   Michal Kubecek   ethtool: set link... 
398
399
 
  		goto out_ops;
  	}
bfbcfe203   Michal Kubecek   ethtool: set link... 
400
401
402
403
404
405
406
407
408
 
  
  	ret = ethnl_update_linkmodes(info, tb, &ksettings, &mod);
  	if (ret < 0)
  		goto out_ops;
  
  	if (mod) {
  		ret = dev->ethtool_ops->set_link_ksettings(dev, &ksettings);
  		if (ret < 0)
  			GENL_SET_ERR_MSG(info, "link settings update failed");
1b1b1847c   Michal Kubecek   ethtool: add LINK... 
409
410
 
  		else
  			ethtool_notify(dev, ETHTOOL_MSG_LINKMODES_NTF, NULL);
bfbcfe203   Michal Kubecek   ethtool: set link... 
411
412
413
414
415
416
 
  	}
  
  out_ops:
  	ethnl_ops_complete(dev);
  out_rtnl:
  	rtnl_unlock();
2f599ec42   Michal Kubecek   ethtool: fix refe... 
417
 
  out_dev:
bfbcfe203   Michal Kubecek   ethtool: set link... 
418
419
420
 
  	dev_put(dev);
  	return ret;
  }