1 // SPDX-License-Identifier: GPL-2.0-only
32 	struct linkmodes_reply_data *data = LINKMODES_REPDATA(reply_base);  in linkmodes_prepare_data()  local
33 	struct net_device *dev = reply_base->dev;  in linkmodes_prepare_data()
36 	data->lsettings = &data->ksettings.base;  in linkmodes_prepare_data()
42 	ret = __ethtool_get_link_ksettings(dev, &data->ksettings);  in linkmodes_prepare_data()
48 	if (!dev->ethtool_ops->cap_link_lanes_supported)  in linkmodes_prepare_data()
49 		data->ksettings.lanes = 0;  in linkmodes_prepare_data()
51 	data->peer_empty =  in linkmodes_prepare_data()
52 		bitmap_empty(data->ksettings.link_modes.lp_advertising,  in linkmodes_prepare_data()
63 	const struct linkmodes_reply_data *data = LINKMODES_REPDATA(reply_base);  in linkmodes_reply_size()  local
64 	const struct ethtool_link_ksettings *ksettings = &data->ksettings;  in linkmodes_reply_size()
65 	const struct ethtool_link_settings *lsettings = &ksettings->base;  in linkmodes_reply_size()
66 	bool compact = req_base->flags & ETHTOOL_FLAG_COMPACT_BITSETS;  in linkmodes_reply_size()
74 	ret = ethnl_bitset_size(ksettings->link_modes.advertising,  in linkmodes_reply_size()
75 				ksettings->link_modes.supported,  in linkmodes_reply_size()
81 	if (!data->peer_empty) {  in linkmodes_reply_size()
82 		ret = ethnl_bitset_size(ksettings->link_modes.lp_advertising,  in linkmodes_reply_size()
90 	if (lsettings->master_slave_cfg != MASTER_SLAVE_CFG_UNSUPPORTED)  in linkmodes_reply_size()
93 	if (lsettings->master_slave_state != MASTER_SLAVE_STATE_UNSUPPORTED)  in linkmodes_reply_size()
103 	const struct linkmodes_reply_data *data = LINKMODES_REPDATA(reply_base);  in linkmodes_fill_reply()  local
104 	const struct ethtool_link_ksettings *ksettings = &data->ksettings;  in linkmodes_fill_reply()
105 	const struct ethtool_link_settings *lsettings = &ksettings->base;  in linkmodes_fill_reply()
106 	bool compact = req_base->flags & ETHTOOL_FLAG_COMPACT_BITSETS;  in linkmodes_fill_reply()
109 	if (nla_put_u8(skb, ETHTOOL_A_LINKMODES_AUTONEG, lsettings->autoneg))  in linkmodes_fill_reply()
110 		return -EMSGSIZE;  in linkmodes_fill_reply()
113 			       ksettings->link_modes.advertising,  in linkmodes_fill_reply()
114 			       ksettings->link_modes.supported,  in linkmodes_fill_reply()
118 		return -EMSGSIZE;  in linkmodes_fill_reply()
119 	if (!data->peer_empty) {  in linkmodes_fill_reply()
121 				       ksettings->link_modes.lp_advertising,  in linkmodes_fill_reply()
125 			return -EMSGSIZE;  in linkmodes_fill_reply()
128 	if (nla_put_u32(skb, ETHTOOL_A_LINKMODES_SPEED, lsettings->speed) ||  in linkmodes_fill_reply()
129 	    nla_put_u8(skb, ETHTOOL_A_LINKMODES_DUPLEX, lsettings->duplex))  in linkmodes_fill_reply()
130 		return -EMSGSIZE;  in linkmodes_fill_reply()
132 	if (ksettings->lanes &&  in linkmodes_fill_reply()
133 	    nla_put_u32(skb, ETHTOOL_A_LINKMODES_LANES, ksettings->lanes))  in linkmodes_fill_reply()
134 		return -EMSGSIZE;  in linkmodes_fill_reply()
136 	if (lsettings->master_slave_cfg != MASTER_SLAVE_CFG_UNSUPPORTED &&  in linkmodes_fill_reply()
138 		       lsettings->master_slave_cfg))  in linkmodes_fill_reply()
139 		return -EMSGSIZE;  in linkmodes_fill_reply()
141 	if (lsettings->master_slave_state != MASTER_SLAVE_STATE_UNSUPPORTED &&  in linkmodes_fill_reply()
143 		       lsettings->master_slave_state))  in linkmodes_fill_reply()
144 		return -EMSGSIZE;  in linkmodes_fill_reply()
175  * lanes and duplex values. Called when autonegotiation is on, speed, lanes or
183 	unsigned long *advertising = ksettings->link_modes.advertising;  in ethnl_auto_linkmodes()
184 	unsigned long *supported = ksettings->link_modes.supported;  in ethnl_auto_linkmodes()
193 		if (info->speed == SPEED_UNKNOWN)  in ethnl_auto_linkmodes()
196 		    (!req_speed || info->speed == ksettings->base.speed) &&  in ethnl_auto_linkmodes()
197 		    (!req_lanes || info->lanes == ksettings->lanes) &&  in ethnl_auto_linkmodes()
198 		    (!req_duplex || info->duplex == ksettings->base.duplex))  in ethnl_auto_linkmodes()
228 		NL_SET_ERR_MSG_ATTR(info->extack, master_slave_cfg,  in ethnl_check_linkmodes()
230 		return -EOPNOTSUPP;  in ethnl_check_linkmodes()
235 		NL_SET_ERR_MSG_ATTR(info->extack, lanes_cfg,  in ethnl_check_linkmodes()
236 				    "lanes value is invalid");  in ethnl_check_linkmodes()
237 		return -EINVAL;  in ethnl_check_linkmodes()
247 	struct ethtool_link_settings *lsettings = &ksettings->base;  in ethnl_update_linkmodes()
254 		if (lsettings->master_slave_cfg == MASTER_SLAVE_CFG_UNSUPPORTED) {  in ethnl_update_linkmodes()
255 			NL_SET_ERR_MSG_ATTR(info->extack, master_slave_cfg,  in ethnl_update_linkmodes()
257 			return -EOPNOTSUPP;  in ethnl_update_linkmodes()
266 	ethnl_update_u8(&lsettings->autoneg, tb[ETHTOOL_A_LINKMODES_AUTONEG],  in ethnl_update_linkmodes()
271 		/* If autoneg is off and lanes parameter is not supported by the  in ethnl_update_linkmodes()
274 		if (!lsettings->autoneg &&  in ethnl_update_linkmodes()
275 		    !dev->ethtool_ops->cap_link_lanes_supported) {  in ethnl_update_linkmodes()
276 			NL_SET_ERR_MSG_ATTR(info->extack, lanes_cfg,  in ethnl_update_linkmodes()
277 					    "lanes configuration not supported by device");  in ethnl_update_linkmodes()
278 			return -EOPNOTSUPP;  in ethnl_update_linkmodes()
280 	} else if (!lsettings->autoneg) {  in ethnl_update_linkmodes()
281 		/* If autoneg is off and lanes parameter is not passed from user,  in ethnl_update_linkmodes()
282 		 * set the lanes parameter to 0.  in ethnl_update_linkmodes()
284 		ksettings->lanes = 0;  in ethnl_update_linkmodes()
287 	ret = ethnl_update_bitset(ksettings->link_modes.advertising,  in ethnl_update_linkmodes()
290 				  info->extack, mod);  in ethnl_update_linkmodes()
293 	ethnl_update_u32(&lsettings->speed, tb[ETHTOOL_A_LINKMODES_SPEED],  in ethnl_update_linkmodes()
295 	ethnl_update_u32(&ksettings->lanes, lanes_cfg, mod);  in ethnl_update_linkmodes()
296 	ethnl_update_u8(&lsettings->duplex, tb[ETHTOOL_A_LINKMODES_DUPLEX],  in ethnl_update_linkmodes()
298 	ethnl_update_u8(&lsettings->master_slave_cfg, master_slave_cfg, mod);  in ethnl_update_linkmodes()
300 	if (!tb[ETHTOOL_A_LINKMODES_OURS] && lsettings->autoneg &&  in ethnl_update_linkmodes()
312 	struct nlattr **tb = info->attrs;  in ethnl_set_linkmodes()
323 					 genl_info_net(info), info->extack,  in ethnl_set_linkmodes()
328 	ret = -EOPNOTSUPP;  in ethnl_set_linkmodes()
329 	if (!dev->ethtool_ops->get_link_ksettings ||  in ethnl_set_linkmodes()
330 	    !dev->ethtool_ops->set_link_ksettings)  in ethnl_set_linkmodes()
349 		ret = dev->ethtool_ops->set_link_ksettings(dev, &ksettings);  in ethnl_set_linkmodes()