1 // SPDX-License-Identifier: GPL-2.0+
2 /* Microchip Sparx5 Switch driver
21 		/* Max width is 5 bytes - 40 bits. In worst case this will
22 		 * spread over 6 bytes - 48 bits
33 	u32 byte = (35 - (pos / 8));  in __ifh_encode_bitfield()
36 	u64 encode = GENMASK_ULL(bit + width - 1, bit) & (value << bit);  in __ifh_encode_bitfield()
38 	/* The b0-b7 goes into the start IFH byte */  in __ifh_encode_bitfield()
41 	/* The b8-b15 goes into the next IFH byte */  in __ifh_encode_bitfield()
43 		ifh_hdr[byte - 1] |= (u8)((encode & 0xFF00) >> 8);  in __ifh_encode_bitfield()
44 	/* The b16-b23 goes into the next IFH byte */  in __ifh_encode_bitfield()
46 		ifh_hdr[byte - 2] |= (u8)((encode & 0xFF0000) >> 16);  in __ifh_encode_bitfield()
47 	/* The b24-b31 goes into the next IFH byte */  in __ifh_encode_bitfield()
49 		ifh_hdr[byte - 3] |= (u8)((encode & 0xFF000000) >> 24);  in __ifh_encode_bitfield()
50 	/* The b32-b39 goes into the next IFH byte */  in __ifh_encode_bitfield()
52 		ifh_hdr[byte - 4] |= (u8)((encode & 0xFF00000000) >> 32);  in __ifh_encode_bitfield()
53 	/* The b40-b47 goes into the next IFH byte */  in __ifh_encode_bitfield()
55 		ifh_hdr[byte - 5] |= (u8)((encode & 0xFF0000000000) >> 40);  in __ifh_encode_bitfield()
58 void sparx5_set_port_ifh(struct sparx5 *sparx5, void *ifh_hdr, u16 portno)  in sparx5_set_port_ifh()  argument
62 	/* VSTAX.INGR_DROP_MODE = Enable. Don't make head-of-line blocking */  in sparx5_set_port_ifh()
67 	ifh_encode_bitfield(ifh_hdr, is_sparx5(sparx5) ? 16 : 17, 37, 5);  in sparx5_set_port_ifh()
71 	ifh_encode_bitfield(ifh_hdr, sparx5_get_pgid(sparx5, SPX5_PORT_CPU_0),  in sparx5_set_port_ifh()
72 			    46, is_sparx5(sparx5) ? 7 : 6);  in sparx5_set_port_ifh()
74 	ifh_encode_bitfield(ifh_hdr, 124,      is_sparx5(sparx5) ? 57 : 56, 7);  in sparx5_set_port_ifh()
76 	ifh_encode_bitfield(ifh_hdr, 1,        is_sparx5(sparx5) ? 67 : 66, 1);  in sparx5_set_port_ifh()
84 void sparx5_set_port_ifh_pdu_type(struct sparx5 *sparx5, void *ifh_hdr,  in sparx5_set_port_ifh_pdu_type()  argument
87 	ifh_encode_bitfield(ifh_hdr, pdu_type, is_sparx5(sparx5) ? 191 : 190,  in sparx5_set_port_ifh_pdu_type()
91 void sparx5_set_port_ifh_pdu_w16_offset(struct sparx5 *sparx5, void *ifh_hdr,  in sparx5_set_port_ifh_pdu_w16_offset()  argument
95 			    is_sparx5(sparx5) ? 195 : 194, 6);  in sparx5_set_port_ifh_pdu_w16_offset()
98 void sparx5_set_port_ifh_timestamp(struct sparx5 *sparx5, void *ifh_hdr,  in sparx5_set_port_ifh_timestamp()  argument
102 			    is_sparx5(sparx5) ? 40 : 38);  in sparx5_set_port_ifh_timestamp()
111 	err = phylink_of_phy_connect(port->phylink, port->of_node, 0);  in sparx5_port_open()
117 	phylink_start(port->phylink);  in sparx5_port_open()
119 	if (!ndev->phydev) {  in sparx5_port_open()
121 		port->conf.power_down = false;  in sparx5_port_open()
122 		if (port->conf.serdes_reset)  in sparx5_port_open()
123 			err = sparx5_serdes_set(port->sparx5, port, &port->conf);  in sparx5_port_open()
125 			err = phy_power_on(port->serdes);  in sparx5_port_open()
135 	phylink_stop(port->phylink);  in sparx5_port_open()
136 	phylink_disconnect_phy(port->phylink);  in sparx5_port_open()
149 	phylink_stop(port->phylink);  in sparx5_port_stop()
150 	phylink_disconnect_phy(port->phylink);  in sparx5_port_stop()
152 	if (!ndev->phydev) {  in sparx5_port_stop()
154 		port->conf.power_down = true;  in sparx5_port_stop()
155 		if (port->conf.serdes_reset)  in sparx5_port_stop()
156 			err = sparx5_serdes_set(port->sparx5, port, &port->conf);  in sparx5_port_stop()
158 			err = phy_power_off(port->serdes);  in sparx5_port_stop()
168 	struct sparx5 *sparx5 = port->sparx5;  in sparx5_set_rx_mode()  local
170 	if (!test_bit(port->portno, sparx5->bridge_mask))  in sparx5_set_rx_mode()
180 	ret = snprintf(buf, len, "p%d", port->portno);  in sparx5_port_get_phys_port_name()
182 		return -EINVAL;  in sparx5_port_get_phys_port_name()
190 	struct sparx5 *sparx5 = port->sparx5;  in sparx5_set_mac_address()  local
193 	if (!is_valid_ether_addr(addr->sa_data))  in sparx5_set_mac_address()
194 		return -EADDRNOTAVAIL;  in sparx5_set_mac_address()
197 	sparx5_mact_forget(sparx5, dev->dev_addr,  port->pvid);  in sparx5_set_mac_address()
200 	sparx5_mact_learn(sparx5, sparx5_get_pgid(sparx5, PGID_CPU),  in sparx5_set_mac_address()
201 			  addr->sa_data, port->pvid);  in sparx5_set_mac_address()
204 	eth_hw_addr_set(dev, addr->sa_data);  in sparx5_set_mac_address()
213 	struct sparx5 *sparx5 = sparx5_port->sparx5;  in sparx5_get_port_parent_id()  local
215 	ppid->id_len = sizeof(sparx5->base_mac);  in sparx5_get_port_parent_id()
216 	memcpy(&ppid->id, &sparx5->base_mac, ppid->id_len);  in sparx5_get_port_parent_id()
225 	struct sparx5 *sparx5 = sparx5_port->sparx5;  in sparx5_port_hwtstamp_get()  local
227 	if (!sparx5->ptp)  in sparx5_port_hwtstamp_get()
228 		return -EOPNOTSUPP;  in sparx5_port_hwtstamp_get()
240 	struct sparx5 *sparx5 = sparx5_port->sparx5;  in sparx5_port_hwtstamp_set()  local
242 	if (!sparx5->ptp)  in sparx5_port_hwtstamp_set()
243 		return -EOPNOTSUPP;  in sparx5_port_hwtstamp_set()
266 	return dev && (dev->netdev_ops == &sparx5_port_netdev_ops);  in sparx5_netdevice_check()
269 struct net_device *sparx5_create_netdev(struct sparx5 *sparx5, u32 portno)  in sparx5_create_netdev()  argument
274 	ndev = devm_alloc_etherdev_mqs(sparx5->dev, sizeof(struct sparx5_port),  in sparx5_create_netdev()
277 		return ERR_PTR(-ENOMEM);  in sparx5_create_netdev()
279 	ndev->hw_features |= NETIF_F_HW_TC;  in sparx5_create_netdev()
280 	ndev->features |= NETIF_F_HW_TC;  in sparx5_create_netdev()
282 	SET_NETDEV_DEV(ndev, sparx5->dev);  in sparx5_create_netdev()
284 	spx5_port->ndev = ndev;  in sparx5_create_netdev()
285 	spx5_port->sparx5 = sparx5;  in sparx5_create_netdev()
286 	spx5_port->portno = portno;  in sparx5_create_netdev()
288 	ndev->netdev_ops = &sparx5_port_netdev_ops;  in sparx5_create_netdev()
289 	ndev->ethtool_ops = &sparx5_ethtool_ops;  in sparx5_create_netdev()
291 	eth_hw_addr_gen(ndev, sparx5->base_mac, portno + 1);  in sparx5_create_netdev()
296 int sparx5_register_netdevs(struct sparx5 *sparx5)  in sparx5_register_netdevs()  argument
301 	for (portno = 0; portno < sparx5->data->consts->n_ports; portno++)  in sparx5_register_netdevs()
302 		if (sparx5->ports[portno]) {  in sparx5_register_netdevs()
303 			err = register_netdev(sparx5->ports[portno]->ndev);  in sparx5_register_netdevs()
305 				dev_err(sparx5->dev,  in sparx5_register_netdevs()
310 			sparx5_port_inj_timer_setup(sparx5->ports[portno]);  in sparx5_register_netdevs()
315 void sparx5_destroy_netdevs(struct sparx5 *sparx5)  in sparx5_destroy_netdevs()  argument
320 	for (portno = 0; portno < sparx5->data->consts->n_ports; portno++) {  in sparx5_destroy_netdevs()
321 		port = sparx5->ports[portno];  in sparx5_destroy_netdevs()
322 		if (port && port->phylink) {  in sparx5_destroy_netdevs()
325 			sparx5_port_stop(port->ndev);  in sparx5_destroy_netdevs()
326 			phylink_disconnect_phy(port->phylink);  in sparx5_destroy_netdevs()
328 			phylink_destroy(port->phylink);  in sparx5_destroy_netdevs()
329 			port->phylink = NULL;  in sparx5_destroy_netdevs()
334 void sparx5_unregister_netdevs(struct sparx5 *sparx5)  in sparx5_unregister_netdevs()  argument
338 	for (portno = 0; portno < sparx5->data->consts->n_ports; portno++)  in sparx5_unregister_netdevs()
339 		if (sparx5->ports[portno])  in sparx5_unregister_netdevs()
340 			unregister_netdev(sparx5->ports[portno]->ndev);  in sparx5_unregister_netdevs()