1 // SPDX-License-Identifier: GPL-2.0+
2 /* Microchip Sparx5 Switch driver
3  *
4  * Copyright (c) 2021 Microchip Technology Inc. and its subsidiaries.
5  */
6 
7 #include "sparx5_main_regs.h"
8 #include "sparx5_main.h"
9 #include "sparx5_port.h"
10 #include "sparx5_tc.h"
11 
12 /* The IFH bit position of the first VSTAX bit. This is because the
13  * VSTAX bit positions in Data sheet is starting from zero.
14  */
15 #define VSTAX 73
16 
17 #define ifh_encode_bitfield(ifh, value, pos, _width)			\
18 	({								\
19 		u32 width = (_width);					\
20 									\
21 		/* Max width is 5 bytes - 40 bits. In worst case this will
22 		 * spread over 6 bytes - 48 bits
23 		 */							\
24 		compiletime_assert(width <= 40,				\
25 				   "Unsupported width, must be <= 40");	\
26 		__ifh_encode_bitfield((ifh), (value), (pos), width);	\
27 	})
28 
29 static void __ifh_encode_bitfield(void *ifh, u64 value, u32 pos, u32 width)
30 {
31 	u8 *ifh_hdr = ifh;
32 	/* Calculate the Start IFH byte position of this IFH bit position */
33 	u32 byte = (35 - (pos / 8));
34 	/* Calculate the Start bit position in the Start IFH byte */
35 	u32 bit  = (pos % 8);
36 	u64 encode = GENMASK_ULL(bit + width - 1, bit) & (value << bit);
37 
38 	/* The b0-b7 goes into the start IFH byte */
39 	if (encode & 0xFF)
40 		ifh_hdr[byte] |= (u8)((encode & 0xFF));
41 	/* The b8-b15 goes into the next IFH byte */
42 	if (encode & 0xFF00)
43 		ifh_hdr[byte - 1] |= (u8)((encode & 0xFF00) >> 8);
44 	/* The b16-b23 goes into the next IFH byte */
45 	if (encode & 0xFF0000)
46 		ifh_hdr[byte - 2] |= (u8)((encode & 0xFF0000) >> 16);
47 	/* The b24-b31 goes into the next IFH byte */
48 	if (encode & 0xFF000000)
49 		ifh_hdr[byte - 3] |= (u8)((encode & 0xFF000000) >> 24);
50 	/* The b32-b39 goes into the next IFH byte */
51 	if (encode & 0xFF00000000)
52 		ifh_hdr[byte - 4] |= (u8)((encode & 0xFF00000000) >> 32);
53 	/* The b40-b47 goes into the next IFH byte */
54 	if (encode & 0xFF0000000000)
55 		ifh_hdr[byte - 5] |= (u8)((encode & 0xFF0000000000) >> 40);
56 }
57 
58 void sparx5_set_port_ifh(void *ifh_hdr, u16 portno)
59 {
60 	/* VSTAX.RSV = 1. MSBit must be 1 */
61 	ifh_encode_bitfield(ifh_hdr, 1, VSTAX + 79,  1);
62 	/* VSTAX.INGR_DROP_MODE = Enable. Don't make head-of-line blocking */
63 	ifh_encode_bitfield(ifh_hdr, 1, VSTAX + 55,  1);
64 	/* MISC.CPU_MASK/DPORT = Destination port */
65 	ifh_encode_bitfield(ifh_hdr, portno,   29, 8);
66 	/* MISC.PIPELINE_PT */
67 	ifh_encode_bitfield(ifh_hdr, 16,       37, 5);
68 	/* MISC.PIPELINE_ACT */
69 	ifh_encode_bitfield(ifh_hdr, 1,        42, 3);
70 	/* FWD.SRC_PORT = CPU */
71 	ifh_encode_bitfield(ifh_hdr, SPX5_PORT_CPU, 46, 7);
72 	/* FWD.SFLOW_ID (disable SFlow sampling) */
73 	ifh_encode_bitfield(ifh_hdr, 124,      57, 7);
74 	/* FWD.UPDATE_FCS = Enable. Enforce update of FCS. */
75 	ifh_encode_bitfield(ifh_hdr, 1,        67, 1);
76 }
77 
78 void sparx5_set_port_ifh_rew_op(void *ifh_hdr, u32 rew_op)
79 {
80 	ifh_encode_bitfield(ifh_hdr, rew_op, VSTAX + 32,  10);
81 }
82 
83 void sparx5_set_port_ifh_pdu_type(void *ifh_hdr, u32 pdu_type)
84 {
85 	ifh_encode_bitfield(ifh_hdr, pdu_type, 191, 4);
86 }
87 
88 void sparx5_set_port_ifh_pdu_w16_offset(void *ifh_hdr, u32 pdu_w16_offset)
89 {
90 	ifh_encode_bitfield(ifh_hdr, pdu_w16_offset, 195, 6);
91 }
92 
93 void sparx5_set_port_ifh_timestamp(void *ifh_hdr, u64 timestamp)
94 {
95 	ifh_encode_bitfield(ifh_hdr, timestamp, 232,  40);
96 }
97 
98 static int sparx5_port_open(struct net_device *ndev)
99 {
100 	struct sparx5_port *port = netdev_priv(ndev);
101 	int err = 0;
102 
103 	sparx5_port_enable(port, true);
104 	err = phylink_of_phy_connect(port->phylink, port->of_node, 0);
105 	if (err) {
106 		netdev_err(ndev, "Could not attach to PHY\n");
107 		return err;
108 	}
109 
110 	phylink_start(port->phylink);
111 
112 	if (!ndev->phydev) {
113 		/* power up serdes */
114 		port->conf.power_down = false;
115 		if (port->conf.serdes_reset)
116 			err = sparx5_serdes_set(port->sparx5, port, &port->conf);
117 		else
118 			err = phy_power_on(port->serdes);
119 		if (err)
120 			netdev_err(ndev, "%s failed\n", __func__);
121 	}
122 
123 	return err;
124 }
125 
126 static int sparx5_port_stop(struct net_device *ndev)
127 {
128 	struct sparx5_port *port = netdev_priv(ndev);
129 	int err = 0;
130 
131 	sparx5_port_enable(port, false);
132 	phylink_stop(port->phylink);
133 	phylink_disconnect_phy(port->phylink);
134 
135 	if (!ndev->phydev) {
136 		/* power down serdes */
137 		port->conf.power_down = true;
138 		if (port->conf.serdes_reset)
139 			err = sparx5_serdes_set(port->sparx5, port, &port->conf);
140 		else
141 			err = phy_power_off(port->serdes);
142 		if (err)
143 			netdev_err(ndev, "%s failed\n", __func__);
144 	}
145 	return 0;
146 }
147 
148 static void sparx5_set_rx_mode(struct net_device *dev)
149 {
150 	struct sparx5_port *port = netdev_priv(dev);
151 	struct sparx5 *sparx5 = port->sparx5;
152 
153 	if (!test_bit(port->portno, sparx5->bridge_mask))
154 		__dev_mc_sync(dev, sparx5_mc_sync, sparx5_mc_unsync);
155 }
156 
157 static int sparx5_port_get_phys_port_name(struct net_device *dev,
158 					  char *buf, size_t len)
159 {
160 	struct sparx5_port *port = netdev_priv(dev);
161 	int ret;
162 
163 	ret = snprintf(buf, len, "p%d", port->portno);
164 	if (ret >= len)
165 		return -EINVAL;
166 
167 	return 0;
168 }
169 
170 static int sparx5_set_mac_address(struct net_device *dev, void *p)
171 {
172 	struct sparx5_port *port = netdev_priv(dev);
173 	struct sparx5 *sparx5 = port->sparx5;
174 	const struct sockaddr *addr = p;
175 
176 	if (!is_valid_ether_addr(addr->sa_data))
177 		return -EADDRNOTAVAIL;
178 
179 	/* Remove current */
180 	sparx5_mact_forget(sparx5, dev->dev_addr,  port->pvid);
181 
182 	/* Add new */
183 	sparx5_mact_learn(sparx5, PGID_CPU, addr->sa_data, port->pvid);
184 
185 	/* Record the address */
186 	eth_hw_addr_set(dev, addr->sa_data);
187 
188 	return 0;
189 }
190 
191 static int sparx5_get_port_parent_id(struct net_device *dev,
192 				     struct netdev_phys_item_id *ppid)
193 {
194 	struct sparx5_port *sparx5_port = netdev_priv(dev);
195 	struct sparx5 *sparx5 = sparx5_port->sparx5;
196 
197 	ppid->id_len = sizeof(sparx5->base_mac);
198 	memcpy(&ppid->id, &sparx5->base_mac, ppid->id_len);
199 
200 	return 0;
201 }
202 
203 static int sparx5_port_ioctl(struct net_device *dev, struct ifreq *ifr,
204 			     int cmd)
205 {
206 	struct sparx5_port *sparx5_port = netdev_priv(dev);
207 	struct sparx5 *sparx5 = sparx5_port->sparx5;
208 
209 	if (!phy_has_hwtstamp(dev->phydev) && sparx5->ptp) {
210 		switch (cmd) {
211 		case SIOCSHWTSTAMP:
212 			return sparx5_ptp_hwtstamp_set(sparx5_port, ifr);
213 		case SIOCGHWTSTAMP:
214 			return sparx5_ptp_hwtstamp_get(sparx5_port, ifr);
215 		}
216 	}
217 
218 	return phy_mii_ioctl(dev->phydev, ifr, cmd);
219 }
220 
221 static const struct net_device_ops sparx5_port_netdev_ops = {
222 	.ndo_open               = sparx5_port_open,
223 	.ndo_stop               = sparx5_port_stop,
224 	.ndo_start_xmit         = sparx5_port_xmit_impl,
225 	.ndo_set_rx_mode        = sparx5_set_rx_mode,
226 	.ndo_get_phys_port_name = sparx5_port_get_phys_port_name,
227 	.ndo_set_mac_address    = sparx5_set_mac_address,
228 	.ndo_validate_addr      = eth_validate_addr,
229 	.ndo_get_stats64        = sparx5_get_stats64,
230 	.ndo_get_port_parent_id = sparx5_get_port_parent_id,
231 	.ndo_eth_ioctl          = sparx5_port_ioctl,
232 	.ndo_setup_tc           = sparx5_port_setup_tc,
233 };
234 
235 bool sparx5_netdevice_check(const struct net_device *dev)
236 {
237 	return dev && (dev->netdev_ops == &sparx5_port_netdev_ops);
238 }
239 
240 struct net_device *sparx5_create_netdev(struct sparx5 *sparx5, u32 portno)
241 {
242 	struct sparx5_port *spx5_port;
243 	struct net_device *ndev;
244 
245 	ndev = devm_alloc_etherdev_mqs(sparx5->dev, sizeof(struct sparx5_port),
246 				       SPX5_PRIOS, 1);
247 	if (!ndev)
248 		return ERR_PTR(-ENOMEM);
249 
250 	ndev->hw_features |= NETIF_F_HW_TC;
251 	ndev->features |= NETIF_F_HW_TC;
252 
253 	SET_NETDEV_DEV(ndev, sparx5->dev);
254 	spx5_port = netdev_priv(ndev);
255 	spx5_port->ndev = ndev;
256 	spx5_port->sparx5 = sparx5;
257 	spx5_port->portno = portno;
258 
259 	ndev->netdev_ops = &sparx5_port_netdev_ops;
260 	ndev->ethtool_ops = &sparx5_ethtool_ops;
261 
262 	eth_hw_addr_gen(ndev, sparx5->base_mac, portno + 1);
263 
264 	return ndev;
265 }
266 
267 int sparx5_register_netdevs(struct sparx5 *sparx5)
268 {
269 	int portno;
270 	int err;
271 
272 	for (portno = 0; portno < SPX5_PORTS; portno++)
273 		if (sparx5->ports[portno]) {
274 			err = register_netdev(sparx5->ports[portno]->ndev);
275 			if (err) {
276 				dev_err(sparx5->dev,
277 					"port: %02u: netdev registration failed\n",
278 					portno);
279 				return err;
280 			}
281 			sparx5_port_inj_timer_setup(sparx5->ports[portno]);
282 		}
283 	return 0;
284 }
285 
286 void sparx5_destroy_netdevs(struct sparx5 *sparx5)
287 {
288 	struct sparx5_port *port;
289 	int portno;
290 
291 	for (portno = 0; portno < SPX5_PORTS; portno++) {
292 		port = sparx5->ports[portno];
293 		if (port && port->phylink) {
294 			/* Disconnect the phy */
295 			rtnl_lock();
296 			sparx5_port_stop(port->ndev);
297 			phylink_disconnect_phy(port->phylink);
298 			rtnl_unlock();
299 			phylink_destroy(port->phylink);
300 			port->phylink = NULL;
301 		}
302 	}
303 }
304 
305 void sparx5_unregister_netdevs(struct sparx5 *sparx5)
306 {
307 	int portno;
308 
309 	for (portno = 0; portno < SPX5_PORTS; portno++)
310 		if (sparx5->ports[portno])
311 			unregister_netdev(sparx5->ports[portno]->ndev);
312 }
313 
314