sparx5_netdev.c

  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
 29static 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
 58void sparx5_set_port_ifh(struct sparx5 *sparx5, 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, is_sparx5(sparx5) ? 16 : 17, 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, sparx5_get_pgid(sparx5, SPX5_PORT_CPU_0),
 72			    46, is_sparx5(sparx5) ? 7 : 6);
 73	/* FWD.SFLOW_ID (disable SFlow sampling) */
 74	ifh_encode_bitfield(ifh_hdr, 124,      is_sparx5(sparx5) ? 57 : 56, 7);
 75	/* FWD.UPDATE_FCS = Enable. Enforce update of FCS. */
 76	ifh_encode_bitfield(ifh_hdr, 1,        is_sparx5(sparx5) ? 67 : 66, 1);
 77}
 78
 79void sparx5_set_port_ifh_rew_op(void *ifh_hdr, u32 rew_op)
 80{
 81	ifh_encode_bitfield(ifh_hdr, rew_op, VSTAX + 32,  10);
 82}
 83
 84void sparx5_set_port_ifh_pdu_type(struct sparx5 *sparx5, void *ifh_hdr,
 85				  u32 pdu_type)
 86{
 87	ifh_encode_bitfield(ifh_hdr, pdu_type, is_sparx5(sparx5) ? 191 : 190,
 88			    4);
 89}
 90
 91void sparx5_set_port_ifh_pdu_w16_offset(struct sparx5 *sparx5, void *ifh_hdr,
 92					u32 pdu_w16_offset)
 93{
 94	ifh_encode_bitfield(ifh_hdr, pdu_w16_offset,
 95			    is_sparx5(sparx5) ? 195 : 194, 6);
 96}
 97
 98void sparx5_set_port_ifh_timestamp(struct sparx5 *sparx5, void *ifh_hdr,
 99				   u64 timestamp)
100{
101	ifh_encode_bitfield(ifh_hdr, timestamp, 232,
102			    is_sparx5(sparx5) ? 40 : 38);
103}
104
105static int sparx5_port_open(struct net_device *ndev)
106{
107	struct sparx5_port *port = netdev_priv(ndev);
108	int err = 0;
109
110	sparx5_port_enable(port, true);
111	err = phylink_of_phy_connect(port->phylink, port->of_node, 0);
112	if (err) {
113		netdev_err(ndev, "Could not attach to PHY\n");
114		goto err_connect;
115	}
116
117	phylink_start(port->phylink);
118
119	if (!ndev->phydev) {
120		/* power up serdes */
121		port->conf.power_down = false;
122		if (port->conf.serdes_reset)
123			err = sparx5_serdes_set(port->sparx5, port, &port->conf);
124		else
125			err = phy_power_on(port->serdes);
126		if (err) {
127			netdev_err(ndev, "%s failed\n", __func__);
128			goto out_power;
129		}
130	}
131
132	return 0;
133
134out_power:
135	phylink_stop(port->phylink);
136	phylink_disconnect_phy(port->phylink);
137err_connect:
138	sparx5_port_enable(port, false);
139
140	return err;
141}
142
143static int sparx5_port_stop(struct net_device *ndev)
144{
145	struct sparx5_port *port = netdev_priv(ndev);
146	int err = 0;
147
148	sparx5_port_enable(port, false);
149	phylink_stop(port->phylink);
150	phylink_disconnect_phy(port->phylink);
151
152	if (!ndev->phydev) {
153		/* power down serdes */
154		port->conf.power_down = true;
155		if (port->conf.serdes_reset)
156			err = sparx5_serdes_set(port->sparx5, port, &port->conf);
157		else
158			err = phy_power_off(port->serdes);
159		if (err)
160			netdev_err(ndev, "%s failed\n", __func__);
161	}
162	return 0;
163}
164
165static void sparx5_set_rx_mode(struct net_device *dev)
166{
167	struct sparx5_port *port = netdev_priv(dev);
168	struct sparx5 *sparx5 = port->sparx5;
169
170	if (!test_bit(port->portno, sparx5->bridge_mask))
171		__dev_mc_sync(dev, sparx5_mc_sync, sparx5_mc_unsync);
172}
173
174static int sparx5_port_get_phys_port_name(struct net_device *dev,
175					  char *buf, size_t len)
176{
177	struct sparx5_port *port = netdev_priv(dev);
178	int ret;
179
180	ret = snprintf(buf, len, "p%d", port->portno);
181	if (ret >= len)
182		return -EINVAL;
183
184	return 0;
185}
186
187static int sparx5_set_mac_address(struct net_device *dev, void *p)
188{
189	struct sparx5_port *port = netdev_priv(dev);
190	struct sparx5 *sparx5 = port->sparx5;
191	const struct sockaddr *addr = p;
192
193	if (!is_valid_ether_addr(addr->sa_data))
194		return -EADDRNOTAVAIL;
195
196	/* Remove current */
197	sparx5_mact_forget(sparx5, dev->dev_addr,  port->pvid);
198
199	/* Add new */
200	sparx5_mact_learn(sparx5, sparx5_get_pgid(sparx5, PGID_CPU),
201			  addr->sa_data, port->pvid);
202
203	/* Record the address */
204	eth_hw_addr_set(dev, addr->sa_data);
205
206	return 0;
207}
208
209static int sparx5_get_port_parent_id(struct net_device *dev,
210				     struct netdev_phys_item_id *ppid)
211{
212	struct sparx5_port *sparx5_port = netdev_priv(dev);
213	struct sparx5 *sparx5 = sparx5_port->sparx5;
214
215	ppid->id_len = sizeof(sparx5->base_mac);
216	memcpy(&ppid->id, &sparx5->base_mac, ppid->id_len);
217
218	return 0;
219}
220
221static int sparx5_port_hwtstamp_get(struct net_device *dev,
222				    struct kernel_hwtstamp_config *cfg)
223{
224	struct sparx5_port *sparx5_port = netdev_priv(dev);
225	struct sparx5 *sparx5 = sparx5_port->sparx5;
226
227	if (!sparx5->ptp)
228		return -EOPNOTSUPP;
229
230	sparx5_ptp_hwtstamp_get(sparx5_port, cfg);
231
232	return 0;
233}
234
235static int sparx5_port_hwtstamp_set(struct net_device *dev,
236				    struct kernel_hwtstamp_config *cfg,
237				    struct netlink_ext_ack *extack)
238{
239	struct sparx5_port *sparx5_port = netdev_priv(dev);
240	struct sparx5 *sparx5 = sparx5_port->sparx5;
241
242	if (!sparx5->ptp)
243		return -EOPNOTSUPP;
244
245	return sparx5_ptp_hwtstamp_set(sparx5_port, cfg, extack);
246}
247
248static const struct net_device_ops sparx5_port_netdev_ops = {
249	.ndo_open               = sparx5_port_open,
250	.ndo_stop               = sparx5_port_stop,
251	.ndo_start_xmit         = sparx5_port_xmit_impl,
252	.ndo_set_rx_mode        = sparx5_set_rx_mode,
253	.ndo_get_phys_port_name = sparx5_port_get_phys_port_name,
254	.ndo_set_mac_address    = sparx5_set_mac_address,
255	.ndo_validate_addr      = eth_validate_addr,
256	.ndo_get_stats64        = sparx5_get_stats64,
257	.ndo_get_port_parent_id = sparx5_get_port_parent_id,
258	.ndo_eth_ioctl          = phy_do_ioctl,
259	.ndo_setup_tc           = sparx5_port_setup_tc,
260	.ndo_hwtstamp_get       = sparx5_port_hwtstamp_get,
261	.ndo_hwtstamp_set       = sparx5_port_hwtstamp_set,
262};
263
264bool sparx5_netdevice_check(const struct net_device *dev)
265{
266	return dev && (dev->netdev_ops == &sparx5_port_netdev_ops);
267}
268
269struct net_device *sparx5_create_netdev(struct sparx5 *sparx5, u32 portno)
270{
271	struct sparx5_port *spx5_port;
272	struct net_device *ndev;
273
274	ndev = devm_alloc_etherdev_mqs(sparx5->dev, sizeof(struct sparx5_port),
275				       SPX5_PRIOS, 1);
276	if (!ndev)
277		return ERR_PTR(-ENOMEM);
278
279	ndev->hw_features |= NETIF_F_HW_TC;
280	ndev->features |= NETIF_F_HW_TC;
281
282	SET_NETDEV_DEV(ndev, sparx5->dev);
283	spx5_port = netdev_priv(ndev);
284	spx5_port->ndev = ndev;
285	spx5_port->sparx5 = sparx5;
286	spx5_port->portno = portno;
287
288	ndev->netdev_ops = &sparx5_port_netdev_ops;
289	ndev->ethtool_ops = &sparx5_ethtool_ops;
290
291	eth_hw_addr_gen(ndev, sparx5->base_mac, portno + 1);
292
293	return ndev;
294}
295
296int sparx5_register_netdevs(struct sparx5 *sparx5)
297{
298	int portno;
299	int err;
300
301	for (portno = 0; portno < sparx5->data->consts->n_ports; portno++)
302		if (sparx5->ports[portno]) {
303			err = register_netdev(sparx5->ports[portno]->ndev);
304			if (err) {
305				dev_err(sparx5->dev,
306					"port: %02u: netdev registration failed\n",
307					portno);
308				return err;
309			}
310			sparx5_port_inj_timer_setup(sparx5->ports[portno]);
311		}
312	return 0;
313}
314
315void sparx5_destroy_netdevs(struct sparx5 *sparx5)
316{
317	struct sparx5_port *port;
318	int portno;
319
320	for (portno = 0; portno < sparx5->data->consts->n_ports; portno++) {
321		port = sparx5->ports[portno];
322		if (port && port->phylink) {
323			/* Disconnect the phy */
324			rtnl_lock();
325			sparx5_port_stop(port->ndev);
326			phylink_disconnect_phy(port->phylink);
327			rtnl_unlock();
328			phylink_destroy(port->phylink);
329			port->phylink = NULL;
330		}
331	}
332}
333
334void sparx5_unregister_netdevs(struct sparx5 *sparx5)
335{
336	int portno;
337
338	for (portno = 0; portno < sparx5->data->consts->n_ports; portno++)
339		if (sparx5->ports[portno])
340			unregister_netdev(sparx5->ports[portno]->ndev);
341}