[thirdparty/u-boot.git] / net / dsa-uclass.c

// SPDX-License-Identifier: GPL-2.0+
/*
 * Copyright 2019-2021 NXP
 */

#include <net/dsa.h>
#include <dm/lists.h>
#include <dm/device_compat.h>
#include <dm/device-internal.h>
#include <dm/uclass-internal.h>
#include <linux/bitmap.h>
#include <miiphy.h>

#define DSA_PORT_CHILD_DRV_NAME "dsa-port"

/* per-device internal state structure */
struct dsa_priv {
	struct phy_device *cpu_port_fixed_phy;
	struct udevice *master_dev;
	int num_ports;
	u32 cpu_port;
	int headroom;
	int tailroom;
};

/* external API */
int dsa_set_tagging(struct udevice *dev, ushort headroom, ushort tailroom)
{
	struct dsa_priv *priv;

	if (!dev)
		return -EINVAL;

	if (headroom + tailroom > DSA_MAX_OVR)
		return -EINVAL;

	priv = dev_get_uclass_priv(dev);

	if (headroom > 0)
		priv->headroom = headroom;
	if (tailroom > 0)
		priv->tailroom = tailroom;

	return 0;
}

ofnode dsa_port_get_ofnode(struct udevice *dev, int port)
{
	struct dsa_pdata *pdata = dev_get_uclass_plat(dev);
	struct dsa_port_pdata *port_pdata;
	struct udevice *pdev;

	if (port == pdata->cpu_port)
		return pdata->cpu_port_node;

	for (device_find_first_child(dev, &pdev);
	     pdev;
	     device_find_next_child(&pdev)) {
		port_pdata = dev_get_parent_plat(pdev);
		if (port_pdata->index == port)
			return dev_ofnode(pdev);
	}

	return ofnode_null();
}

/* returns the DSA master Ethernet device */
struct udevice *dsa_get_master(struct udevice *dev)
{
	struct dsa_priv *priv;

	if (!dev)
		return NULL;

	priv = dev_get_uclass_priv(dev);

	return priv->master_dev;
}

/*
 * Start the desired port, the CPU port and the master Eth interface.
 * TODO: if cascaded we may need to _start ports in other switches too
 */
static int dsa_port_start(struct udevice *pdev)
{
	struct udevice *dev = dev_get_parent(pdev);
	struct dsa_priv *priv = dev_get_uclass_priv(dev);
	struct udevice *master = dsa_get_master(dev);
	struct dsa_ops *ops = dsa_get_ops(dev);
	int err;

	if (ops->port_enable) {
		struct dsa_port_pdata *port_pdata;

		port_pdata = dev_get_parent_plat(pdev);
		err = ops->port_enable(dev, port_pdata->index,
				       port_pdata->phy);
		if (err)
			return err;

		err = ops->port_enable(dev, priv->cpu_port,
				       priv->cpu_port_fixed_phy);
		if (err)
			return err;
	}

	return eth_get_ops(master)->start(master);
}

/* Stop the desired port, the CPU port and the master Eth interface */
static void dsa_port_stop(struct udevice *pdev)
{
	struct udevice *dev = dev_get_parent(pdev);
	struct dsa_priv *priv = dev_get_uclass_priv(dev);
	struct udevice *master = dsa_get_master(dev);
	struct dsa_ops *ops = dsa_get_ops(dev);

	if (ops->port_disable) {
		struct dsa_port_pdata *port_pdata;

		port_pdata = dev_get_parent_plat(pdev);
		ops->port_disable(dev, port_pdata->index, port_pdata->phy);
		ops->port_disable(dev, priv->cpu_port, priv->cpu_port_fixed_phy);
	}

	eth_get_ops(master)->stop(master);
}

/*
 * Insert a DSA tag and call master Ethernet send on the resulting packet
 * We copy the frame to a stack buffer where we have reserved headroom and
 * tailroom space.  Headroom and tailroom are set to 0.
 */
static int dsa_port_send(struct udevice *pdev, void *packet, int length)
{
	struct udevice *dev = dev_get_parent(pdev);
	struct dsa_priv *priv = dev_get_uclass_priv(dev);
	int head = priv->headroom, tail = priv->tailroom;
	struct udevice *master = dsa_get_master(dev);
	struct dsa_ops *ops = dsa_get_ops(dev);
	uchar dsa_packet_tmp[PKTSIZE_ALIGN];
	struct dsa_port_pdata *port_pdata;
	int err;

	if (ops->xmit) {
		if (length + head + tail > PKTSIZE_ALIGN)
			return -EINVAL;

		memset(dsa_packet_tmp, 0, head);
		memset(dsa_packet_tmp + head + length, 0, tail);
		memcpy(dsa_packet_tmp + head, packet, length);
		length += head + tail;
		/* copy back to preserve original buffer alignment */
		memcpy(packet, dsa_packet_tmp, length);

		port_pdata = dev_get_parent_plat(pdev);
		err = ops->xmit(dev, port_pdata->index, packet, length);
		if (err)
			return err;
	}

	return eth_get_ops(master)->send(master, packet, length);
}

/* Receive a frame from master Ethernet, process it and pass it on */
static int dsa_port_recv(struct udevice *pdev, int flags, uchar **packetp)
{
	struct udevice *dev = dev_get_parent(pdev);
	struct dsa_priv *priv = dev_get_uclass_priv(dev);
	int head = priv->headroom, tail = priv->tailroom;
	struct udevice *master = dsa_get_master(dev);
	struct dsa_ops *ops = dsa_get_ops(dev);
	struct dsa_port_pdata *port_pdata;
	int length, port_index, err;

	length = eth_get_ops(master)->recv(master, flags, packetp);
	if (length <= 0 || !ops->rcv)
		return length;

	/*
	 * If we receive frames from a different port or frames that DSA driver
	 * doesn't like we discard them here.
	 * In case of discard we return with no frame and expect to be called
	 * again instead of looping here, so upper layer can deal with timeouts.
	 */
	port_pdata = dev_get_parent_plat(pdev);
	err = ops->rcv(dev, &port_index, *packetp, length);
	if (err || port_index != port_pdata->index || (length <= head + tail)) {
		if (eth_get_ops(master)->free_pkt)
			eth_get_ops(master)->free_pkt(master, *packetp, length);
		return -EAGAIN;
	}

	/*
	 * We move the pointer over headroom here to avoid a copy.  If free_pkt
	 * gets called we move the pointer back before calling master free_pkt.
	 */
	*packetp += head;

	return length - head - tail;
}

static int dsa_port_free_pkt(struct udevice *pdev, uchar *packet, int length)
{
	struct udevice *dev = dev_get_parent(pdev);
	struct udevice *master = dsa_get_master(dev);
	struct dsa_priv *priv;

	priv = dev_get_uclass_priv(dev);
	if (eth_get_ops(master)->free_pkt) {
		/* return the original pointer and length to master Eth */
		packet -= priv->headroom;
		length += priv->headroom - priv->tailroom;

		return eth_get_ops(master)->free_pkt(master, packet, length);
	}

	return 0;
}

static int dsa_port_of_to_pdata(struct udevice *pdev)
{
	struct dsa_port_pdata *port_pdata;
	struct eth_pdata *eth_pdata;
	const char *label;
	u32 index;
	int err;

	if (!pdev)
		return -ENODEV;

	err = ofnode_read_u32(dev_ofnode(pdev), "reg", &index);
	if (err)
		return err;

	port_pdata = dev_get_parent_plat(pdev);
	port_pdata->index = index;

	label = ofnode_read_string(dev_ofnode(pdev), "label");
	if (label)
		strlcpy(port_pdata->name, label, DSA_PORT_NAME_LENGTH);

	eth_pdata = dev_get_plat(pdev);
	eth_pdata->priv_pdata = port_pdata;

	dev_dbg(pdev, "port %d node %s\n", port_pdata->index,
		ofnode_get_name(dev_ofnode(pdev)));

	return 0;
}

static const struct eth_ops dsa_port_ops = {
	.start		= dsa_port_start,
	.send		= dsa_port_send,
	.recv		= dsa_port_recv,
	.stop		= dsa_port_stop,
	.free_pkt	= dsa_port_free_pkt,
};

/*
 * Inherit port's hwaddr from the DSA master, unless the port already has a
 * unique MAC address specified in the environment.
 */
static void dsa_port_set_hwaddr(struct udevice *pdev, struct udevice *master)
{
	struct eth_pdata *eth_pdata, *master_pdata;
	unsigned char env_enetaddr[ARP_HLEN];

	eth_env_get_enetaddr_by_index("eth", dev_seq(pdev), env_enetaddr);
	if (!is_zero_ethaddr(env_enetaddr)) {
		/* individual port mac addrs require master to be promisc */
		struct eth_ops *eth_ops = eth_get_ops(master);

		if (eth_ops->set_promisc)
			eth_ops->set_promisc(master, true);

		return;
	}

	master_pdata = dev_get_plat(master);
	eth_pdata = dev_get_plat(pdev);
	memcpy(eth_pdata->enetaddr, master_pdata->enetaddr, ARP_HLEN);
	eth_env_set_enetaddr_by_index("eth", dev_seq(pdev),
				      master_pdata->enetaddr);
}

static int dsa_port_probe(struct udevice *pdev)
{
	struct udevice *dev = dev_get_parent(pdev);
	struct dsa_ops *ops = dsa_get_ops(dev);
	struct dsa_port_pdata *port_pdata;
	struct udevice *master;
	int err;

	port_pdata = dev_get_parent_plat(pdev);

	port_pdata->phy = dm_eth_phy_connect(pdev);
	if (!port_pdata->phy)
		return -ENODEV;

	master = dsa_get_master(dev);
	if (!master)
		return -ENODEV;

	/*
	 * Probe the master device. We depend on the master device for proper
	 * operation and we also need it for MAC inheritance below.
	 *
	 * TODO: we assume the master device is always there and doesn't get
	 * removed during runtime.
	 */
	err = device_probe(master);
	if (err)
		return err;

	dsa_port_set_hwaddr(pdev, master);

	if (ops->port_probe) {
		err = ops->port_probe(dev, port_pdata->index,
				      port_pdata->phy);
		if (err)
			return err;
	}

	return 0;
}

static int dsa_port_remove(struct udevice *pdev)
{
	struct dsa_port_pdata *port_pdata = dev_get_parent_plat(pdev);

	port_pdata->phy = NULL;

	return 0;
}

U_BOOT_DRIVER(dsa_port) = {
	.name	= DSA_PORT_CHILD_DRV_NAME,
	.id	= UCLASS_ETH,
	.ops	= &dsa_port_ops,
	.probe	= dsa_port_probe,
	.remove	= dsa_port_remove,
	.of_to_plat = dsa_port_of_to_pdata,
	.plat_auto = sizeof(struct eth_pdata),
};

static int dsa_sanitize_ops(struct udevice *dev)
{
	struct dsa_ops *ops = dsa_get_ops(dev);

	if ((!ops->xmit || !ops->rcv) &&
	    (!ops->port_enable && !ops->port_disable)) {
		dev_err(dev, "Packets cannot be steered to ports\n");
		return -EINVAL;
	}

	return 0;
}

/*
 * This function mostly deals with pulling information out of the device tree
 * into the pdata structure.
 * It goes through the list of switch ports, registers an eth device for each
 * front panel port and identifies the cpu port connected to master eth device.
 * TODO: support cascaded switches
 */
static int dsa_post_bind(struct udevice *dev)
{
	struct dsa_pdata *pdata = dev_get_uclass_plat(dev);
	ofnode node = dev_ofnode(dev), pnode;
	int i, err, first_err = 0;

	if (!ofnode_valid(node))
		return -ENODEV;

	err = dsa_sanitize_ops(dev);
	if (err)
		return err;

	pdata->master_node = ofnode_null();

	node = ofnode_find_subnode(node, "ports");
	if (!ofnode_valid(node))
		node = ofnode_find_subnode(dev_ofnode(dev), "ethernet-ports");
	if (!ofnode_valid(node)) {
		dev_err(dev, "ports node is missing under DSA device!\n");
		return -EINVAL;
	}

	pdata->num_ports = ofnode_get_child_count(node);
	if (pdata->num_ports <= 0 || pdata->num_ports > DSA_MAX_PORTS) {
		dev_err(dev, "invalid number of ports (%d)\n",
			pdata->num_ports);
		return -EINVAL;
	}

	/* look for the CPU port */
	ofnode_for_each_subnode(pnode, node) {
		u32 ethernet;

		if (ofnode_read_u32(pnode, "ethernet", &ethernet))
			continue;

		pdata->master_node = ofnode_get_by_phandle(ethernet);
		pdata->cpu_port_node = pnode;
		break;
	}

	if (!ofnode_valid(pdata->master_node)) {
		dev_err(dev, "master eth node missing!\n");
		return -EINVAL;
	}

	if (ofnode_read_u32(pnode, "reg", &pdata->cpu_port)) {
		dev_err(dev, "CPU port node not valid!\n");
		return -EINVAL;
	}

	dev_dbg(dev, "master node %s on port %d\n",
		ofnode_get_name(pdata->master_node), pdata->cpu_port);

	for (i = 0; i < pdata->num_ports; i++) {
		char name[DSA_PORT_NAME_LENGTH];
		struct udevice *pdev;

		/*
		 * If this is the CPU port don't register it as an ETH device,
		 * we skip it on purpose since I/O to/from it from the CPU
		 * isn't useful.
		 */
		if (i == pdata->cpu_port)
			continue;

		/*
		 * Set up default port names.  If present, DT port labels
		 * will override the default port names.
		 */
		snprintf(name, DSA_PORT_NAME_LENGTH, "%s@%d", dev->name, i);

		ofnode_for_each_subnode(pnode, node) {
			u32 reg;

			if (ofnode_read_u32(pnode, "reg", &reg))
				continue;

			if (reg == i)
				break;
		}

		/*
		 * skip registration if port id not found or if the port
		 * is explicitly disabled in DT
		 */
		if (!ofnode_valid(pnode) || !ofnode_is_enabled(pnode))
			continue;

		err = device_bind_driver_to_node(dev, DSA_PORT_CHILD_DRV_NAME,
						 name, pnode, &pdev);
		if (pdev) {
			struct dsa_port_pdata *port_pdata;

			port_pdata = dev_get_parent_plat(pdev);
			strlcpy(port_pdata->name, name, DSA_PORT_NAME_LENGTH);
			pdev->name = port_pdata->name;
		}

		/* try to bind all ports but keep 1st error */
		if (err && !first_err)
			first_err = err;
	}

	if (first_err)
		return first_err;

	dev_dbg(dev, "DSA ports successfully bound\n");

	return 0;
}

/**
 * Initialize the uclass per device internal state structure (priv).
 * TODO: pick up references to other switch devices here, if we're cascaded.
 */
static int dsa_pre_probe(struct udevice *dev)
{
	struct dsa_pdata *pdata = dev_get_uclass_plat(dev);
	struct dsa_priv *priv = dev_get_uclass_priv(dev);
	int err;

	priv->num_ports = pdata->num_ports;
	priv->cpu_port = pdata->cpu_port;
	priv->cpu_port_fixed_phy = fixed_phy_create(pdata->cpu_port_node);
	if (!priv->cpu_port_fixed_phy) {
		dev_err(dev, "Failed to register fixed-link for CPU port\n");
		return -ENODEV;
	}

	err = uclass_get_device_by_ofnode(UCLASS_ETH, pdata->master_node,
					  &priv->master_dev);
	if (err)
		return err;

	return 0;
}

static int dsa_post_probe(struct udevice *dev)
{
	struct dsa_priv *priv = dev_get_uclass_priv(dev);
	struct dsa_ops *ops = dsa_get_ops(dev);
	int err;

	/* Simulate a probing event for the CPU port */
	if (ops->port_probe) {
		err = ops->port_probe(dev, priv->cpu_port,
				      priv->cpu_port_fixed_phy);
		if (err)
			return err;
	}

	return 0;
}

UCLASS_DRIVER(dsa) = {
	.id = UCLASS_DSA,
	.name = "dsa",
	.post_bind = dsa_post_bind,
	.pre_probe = dsa_pre_probe,
	.post_probe = dsa_post_probe,
	.per_device_auto = sizeof(struct dsa_priv),
	.per_device_plat_auto = sizeof(struct dsa_pdata),
	.per_child_plat_auto = sizeof(struct dsa_port_pdata),
	.flags = DM_UC_FLAG_SEQ_ALIAS,
};
Commit	Line	Data
fc054d56 CM	1	// SPDX-License-Identifier: GPL-2.0+
	2	/*
	3	* Copyright 2019-2021 NXP
	4	*/
	5
	6	#include <net/dsa.h>
	7	#include <dm/lists.h>
	8	#include <dm/device_compat.h>
	9	#include <dm/device-internal.h>
	10	#include <dm/uclass-internal.h>
	11	#include <linux/bitmap.h>
	12	#include <miiphy.h>
	13
	14	#define DSA_PORT_CHILD_DRV_NAME "dsa-port"
	15
	16	/* per-device internal state structure */
	17	struct dsa_priv {
	18	struct phy_device *cpu_port_fixed_phy;
	19	struct udevice *master_dev;
	20	int num_ports;
	21	u32 cpu_port;
	22	int headroom;
	23	int tailroom;
	24	};
	25
	26	/* external API */
	27	int dsa_set_tagging(struct udevice *dev, ushort headroom, ushort tailroom)
	28	{
	29	struct dsa_priv *priv;
	30
108157c4 MW	31	if (!dev)
108157c4 MW	32	return -EINVAL;
fc054d56 CM	33
	34	if (headroom + tailroom > DSA_MAX_OVR)
	35	return -EINVAL;
	36
	37	priv = dev_get_uclass_priv(dev);
	38
	39	if (headroom > 0)
	40	priv->headroom = headroom;
	41	if (tailroom > 0)
	42	priv->tailroom = tailroom;
	43
	44	return 0;
	45	}
	46
0783b165 VO	47	ofnode dsa_port_get_ofnode(struct udevice *dev, int port)
	48	{
	49	struct dsa_pdata *pdata = dev_get_uclass_plat(dev);
	50	struct dsa_port_pdata *port_pdata;
	51	struct udevice *pdev;
	52
	53	if (port == pdata->cpu_port)
	54	return pdata->cpu_port_node;
	55
	56	for (device_find_first_child(dev, &pdev);
	57	pdev;
	58	device_find_next_child(&pdev)) {
	59	port_pdata = dev_get_parent_plat(pdev);
	60	if (port_pdata->index == port)
	61	return dev_ofnode(pdev);
	62	}
	63
	64	return ofnode_null();
	65	}
	66
fc054d56 CM	67	/* returns the DSA master Ethernet device */
	68	struct udevice dsa_get_master(struct udevice dev)
	69	{
108157c4	70	struct dsa_priv *priv;
fc054d56	71
108157c4	72	if (!dev)
fc054d56 CM	73	return NULL;
fc054d56 CM	74
108157c4 MW	75	priv = dev_get_uclass_priv(dev);
108157c4 MW	76
fc054d56 CM	77	return priv->master_dev;
	78	}
	79
	80	/*
	81	* Start the desired port, the CPU port and the master Eth interface.
	82	* TODO: if cascaded we may need to _start ports in other switches too
	83	*/
	84	static int dsa_port_start(struct udevice *pdev)
	85	{
	86	struct udevice *dev = dev_get_parent(pdev);
	87	struct dsa_priv *priv = dev_get_uclass_priv(dev);
	88	struct udevice *master = dsa_get_master(dev);
	89	struct dsa_ops *ops = dsa_get_ops(dev);
	90	int err;
	91
fc054d56 CM	92	if (ops->port_enable) {
	93	struct dsa_port_pdata *port_pdata;
	94
	95	port_pdata = dev_get_parent_plat(pdev);
	96	err = ops->port_enable(dev, port_pdata->index,
	97	port_pdata->phy);
	98	if (err)
	99	return err;
	100
	101	err = ops->port_enable(dev, priv->cpu_port,
	102	priv->cpu_port_fixed_phy);
	103	if (err)
	104	return err;
	105	}
	106
	107	return eth_get_ops(master)->start(master);
	108	}
	109
	110	/* Stop the desired port, the CPU port and the master Eth interface */
	111	static void dsa_port_stop(struct udevice *pdev)
	112	{
	113	struct udevice *dev = dev_get_parent(pdev);
	114	struct dsa_priv *priv = dev_get_uclass_priv(dev);
	115	struct udevice *master = dsa_get_master(dev);
	116	struct dsa_ops *ops = dsa_get_ops(dev);
	117
fc054d56 CM	118	if (ops->port_disable) {
	119	struct dsa_port_pdata *port_pdata;
	120
	121	port_pdata = dev_get_parent_plat(pdev);
	122	ops->port_disable(dev, port_pdata->index, port_pdata->phy);
5cc283b7	123	ops->port_disable(dev, priv->cpu_port, priv->cpu_port_fixed_phy);
fc054d56 CM	124	}
fc054d56 CM	125
71455537	126	eth_get_ops(master)->stop(master);
fc054d56 CM	127	}
	128
	129	/*
	130	* Insert a DSA tag and call master Ethernet send on the resulting packet
	131	* We copy the frame to a stack buffer where we have reserved headroom and
	132	* tailroom space. Headroom and tailroom are set to 0.
	133	*/
	134	static int dsa_port_send(struct udevice pdev, void packet, int length)
	135	{
	136	struct udevice *dev = dev_get_parent(pdev);
	137	struct dsa_priv *priv = dev_get_uclass_priv(dev);
	138	int head = priv->headroom, tail = priv->tailroom;
	139	struct udevice *master = dsa_get_master(dev);
	140	struct dsa_ops *ops = dsa_get_ops(dev);
	141	uchar dsa_packet_tmp[PKTSIZE_ALIGN];
	142	struct dsa_port_pdata *port_pdata;
	143	int err;
	144
54d11e20 TH	145	if (ops->xmit) {
	146	if (length + head + tail > PKTSIZE_ALIGN)
	147	return -EINVAL;
fc054d56	148
54d11e20 TH	149	memset(dsa_packet_tmp, 0, head);
	150	memset(dsa_packet_tmp + head + length, 0, tail);
	151	memcpy(dsa_packet_tmp + head, packet, length);
	152	length += head + tail;
	153	/* copy back to preserve original buffer alignment */
	154	memcpy(packet, dsa_packet_tmp, length);
fc054d56	155
54d11e20 TH	156	port_pdata = dev_get_parent_plat(pdev);
	157	err = ops->xmit(dev, port_pdata->index, packet, length);
	158	if (err)
	159	return err;
	160	}
fc054d56 CM	161
	162	return eth_get_ops(master)->send(master, packet, length);
	163	}
	164
	165	/* Receive a frame from master Ethernet, process it and pass it on */
	166	static int dsa_port_recv(struct udevice pdev, int flags, uchar *packetp)
	167	{
	168	struct udevice *dev = dev_get_parent(pdev);
	169	struct dsa_priv *priv = dev_get_uclass_priv(dev);
	170	int head = priv->headroom, tail = priv->tailroom;
	171	struct udevice *master = dsa_get_master(dev);
	172	struct dsa_ops *ops = dsa_get_ops(dev);
	173	struct dsa_port_pdata *port_pdata;
	174	int length, port_index, err;
	175
fc054d56	176	length = eth_get_ops(master)->recv(master, flags, packetp);
54d11e20	177	if (length <= 0 \|\| !ops->rcv)
fc054d56 CM	178	return length;
	179
	180	/*
	181	* If we receive frames from a different port or frames that DSA driver
	182	* doesn't like we discard them here.
	183	* In case of discard we return with no frame and expect to be called
	184	* again instead of looping here, so upper layer can deal with timeouts.
	185	*/
	186	port_pdata = dev_get_parent_plat(pdev);
	187	err = ops->rcv(dev, &port_index, *packetp, length);
	188	if (err \|\| port_index != port_pdata->index \|\| (length <= head + tail)) {
	189	if (eth_get_ops(master)->free_pkt)
	190	eth_get_ops(master)->free_pkt(master, *packetp, length);
	191	return -EAGAIN;
	192	}
	193
	194	/*
	195	* We move the pointer over headroom here to avoid a copy. If free_pkt
	196	* gets called we move the pointer back before calling master free_pkt.
	197	*/
	198	*packetp += head;
	199
	200	return length - head - tail;
	201	}
	202
	203	static int dsa_port_free_pkt(struct udevice pdev, uchar packet, int length)
	204	{
	205	struct udevice *dev = dev_get_parent(pdev);
	206	struct udevice *master = dsa_get_master(dev);
	207	struct dsa_priv *priv;
	208
fc054d56 CM	209	priv = dev_get_uclass_priv(dev);
	210	if (eth_get_ops(master)->free_pkt) {
	211	/* return the original pointer and length to master Eth */
	212	packet -= priv->headroom;
	213	length += priv->headroom - priv->tailroom;
	214
	215	return eth_get_ops(master)->free_pkt(master, packet, length);
	216	}
	217
	218	return 0;
	219	}
	220
	221	static int dsa_port_of_to_pdata(struct udevice *pdev)
	222	{
	223	struct dsa_port_pdata *port_pdata;
fc054d56	224	struct eth_pdata *eth_pdata;
fc054d56 CM	225	const char *label;
	226	u32 index;
	227	int err;
	228
	229	if (!pdev)
	230	return -ENODEV;
	231
	232	err = ofnode_read_u32(dev_ofnode(pdev), "reg", &index);
	233	if (err)
	234	return err;
	235
fc054d56 CM	236	port_pdata = dev_get_parent_plat(pdev);
	237	port_pdata->index = index;
	238
	239	label = ofnode_read_string(dev_ofnode(pdev), "label");
	240	if (label)
4fdc7e35	241	strlcpy(port_pdata->name, label, DSA_PORT_NAME_LENGTH);
fc054d56 CM	242
	243	eth_pdata = dev_get_plat(pdev);
	244	eth_pdata->priv_pdata = port_pdata;
	245
	246	dev_dbg(pdev, "port %d node %s\n", port_pdata->index,
	247	ofnode_get_name(dev_ofnode(pdev)));
	248
	249	return 0;
	250	}
	251
	252	static const struct eth_ops dsa_port_ops = {
	253	.start = dsa_port_start,
	254	.send = dsa_port_send,
	255	.recv = dsa_port_recv,
	256	.stop = dsa_port_stop,
	257	.free_pkt = dsa_port_free_pkt,
	258	};
	259
5eee5ab9 VO	260	/*
	261	* Inherit port's hwaddr from the DSA master, unless the port already has a
	262	* unique MAC address specified in the environment.
	263	*/
	264	static void dsa_port_set_hwaddr(struct udevice pdev, struct udevice master)
fc054d56	265	{
fc054d56 CM	266	struct eth_pdata eth_pdata, master_pdata;
fc054d56 CM	267	unsigned char env_enetaddr[ARP_HLEN];
5eee5ab9 VO	268
	269	eth_env_get_enetaddr_by_index("eth", dev_seq(pdev), env_enetaddr);
	270	if (!is_zero_ethaddr(env_enetaddr)) {
	271	/* individual port mac addrs require master to be promisc */
	272	struct eth_ops *eth_ops = eth_get_ops(master);
	273
	274	if (eth_ops->set_promisc)
c7ae46ef	275	eth_ops->set_promisc(master, true);
5eee5ab9 VO	276
	277	return;
	278	}
	279
	280	master_pdata = dev_get_plat(master);
	281	eth_pdata = dev_get_plat(pdev);
	282	memcpy(eth_pdata->enetaddr, master_pdata->enetaddr, ARP_HLEN);
	283	eth_env_set_enetaddr_by_index("eth", dev_seq(pdev),
	284	master_pdata->enetaddr);
	285	}
	286
	287	static int dsa_port_probe(struct udevice *pdev)
	288	{
	289	struct udevice *dev = dev_get_parent(pdev);
4b46e838	290	struct dsa_ops *ops = dsa_get_ops(dev);
fc054d56	291	struct dsa_port_pdata *port_pdata;
fc054d56	292	struct udevice *master;
f4b712b8	293	int err;
fc054d56 CM	294
fc054d56 CM	295	port_pdata = dev_get_parent_plat(pdev);
fc054d56 CM	296
	297	port_pdata->phy = dm_eth_phy_connect(pdev);
	298	if (!port_pdata->phy)
	299	return -ENODEV;
	300
a02dcbbb MW	301	master = dsa_get_master(dev);
	302	if (!master)
	303	return -ENODEV;
	304
e5d7d119 MW	305	/*
	306	* Probe the master device. We depend on the master device for proper
	307	* operation and we also need it for MAC inheritance below.
71455537 MW	308	*
	309	* TODO: we assume the master device is always there and doesn't get
	310	* removed during runtime.
e5d7d119	311	*/
f4b712b8 VO	312	err = device_probe(master);
	313	if (err)
	314	return err;
e5d7d119	315
5eee5ab9	316	dsa_port_set_hwaddr(pdev, master);
fc054d56	317
4b46e838 VO	318	if (ops->port_probe) {
	319	err = ops->port_probe(dev, port_pdata->index,
	320	port_pdata->phy);
	321	if (err)
	322	return err;
	323	}
	324
fc054d56 CM	325	return 0;
	326	}
	327
	328	static int dsa_port_remove(struct udevice *pdev)
	329	{
5ecdf0a5	330	struct dsa_port_pdata *port_pdata = dev_get_parent_plat(pdev);
fc054d56 CM	331
	332	port_pdata->phy = NULL;
	333
	334	return 0;
	335	}
	336
	337	U_BOOT_DRIVER(dsa_port) = {
	338	.name = DSA_PORT_CHILD_DRV_NAME,
	339	.id = UCLASS_ETH,
	340	.ops = &dsa_port_ops,
	341	.probe = dsa_port_probe,
	342	.remove = dsa_port_remove,
	343	.of_to_plat = dsa_port_of_to_pdata,
	344	.plat_auto = sizeof(struct eth_pdata),
	345	};
	346
43c2a00a TH	347	static int dsa_sanitize_ops(struct udevice *dev)
	348	{
	349	struct dsa_ops *ops = dsa_get_ops(dev);
	350
	351	if ((!ops->xmit \|\| !ops->rcv) &&
	352	(!ops->port_enable && !ops->port_disable)) {
	353	dev_err(dev, "Packets cannot be steered to ports\n");
	354	return -EINVAL;
	355	}
	356
	357	return 0;
	358	}
	359
fc054d56 CM	360	/*
	361	* This function mostly deals with pulling information out of the device tree
	362	* into the pdata structure.
	363	* It goes through the list of switch ports, registers an eth device for each
	364	* front panel port and identifies the cpu port connected to master eth device.
	365	* TODO: support cascaded switches
	366	*/
	367	static int dsa_post_bind(struct udevice *dev)
	368	{
	369	struct dsa_pdata *pdata = dev_get_uclass_plat(dev);
	370	ofnode node = dev_ofnode(dev), pnode;
	371	int i, err, first_err = 0;
	372
108157c4	373	if (!ofnode_valid(node))
fc054d56 CM	374	return -ENODEV;
fc054d56 CM	375
43c2a00a TH	376	err = dsa_sanitize_ops(dev);
	377	if (err)
	378	return err;
	379
fc054d56 CM	380	pdata->master_node = ofnode_null();
	381
	382	node = ofnode_find_subnode(node, "ports");
	383	if (!ofnode_valid(node))
e533228d	384	node = ofnode_find_subnode(dev_ofnode(dev), "ethernet-ports");
fc054d56 CM	385	if (!ofnode_valid(node)) {
	386	dev_err(dev, "ports node is missing under DSA device!\n");
	387	return -EINVAL;
	388	}
	389
	390	pdata->num_ports = ofnode_get_child_count(node);
	391	if (pdata->num_ports <= 0 \|\| pdata->num_ports > DSA_MAX_PORTS) {
	392	dev_err(dev, "invalid number of ports (%d)\n",
	393	pdata->num_ports);
	394	return -EINVAL;
	395	}
	396
	397	/* look for the CPU port */
	398	ofnode_for_each_subnode(pnode, node) {
	399	u32 ethernet;
	400
	401	if (ofnode_read_u32(pnode, "ethernet", &ethernet))
	402	continue;
	403
	404	pdata->master_node = ofnode_get_by_phandle(ethernet);
	405	pdata->cpu_port_node = pnode;
	406	break;
	407	}
	408
	409	if (!ofnode_valid(pdata->master_node)) {
	410	dev_err(dev, "master eth node missing!\n");
	411	return -EINVAL;
	412	}
	413
	414	if (ofnode_read_u32(pnode, "reg", &pdata->cpu_port)) {
	415	dev_err(dev, "CPU port node not valid!\n");
	416	return -EINVAL;
	417	}
	418
	419	dev_dbg(dev, "master node %s on port %d\n",
	420	ofnode_get_name(pdata->master_node), pdata->cpu_port);
	421
	422	for (i = 0; i < pdata->num_ports; i++) {
	423	char name[DSA_PORT_NAME_LENGTH];
	424	struct udevice *pdev;
	425
	426	/*
	427	* If this is the CPU port don't register it as an ETH device,
	428	* we skip it on purpose since I/O to/from it from the CPU
	429	* isn't useful.
	430	*/
	431	if (i == pdata->cpu_port)
	432	continue;
	433
	434	/*
	435	* Set up default port names. If present, DT port labels
	436	* will override the default port names.
	437	*/
	438	snprintf(name, DSA_PORT_NAME_LENGTH, "%s@%d", dev->name, i);
	439
	440	ofnode_for_each_subnode(pnode, node) {
	441	u32 reg;
	442
	443	if (ofnode_read_u32(pnode, "reg", &reg))
	444	continue;
	445
	446	if (reg == i)
	447	break;
	448	}
449
450	/*
451	* skip registration if port id not found or if the port
452	* is explicitly disabled in DT
453	*/
89090661	454	if (!ofnode_valid(pnode) \|\| !ofnode_is_enabled(pnode))
fc054d56 CM	455	continue;
	456
	457	err = device_bind_driver_to_node(dev, DSA_PORT_CHILD_DRV_NAME,
	458	name, pnode, &pdev);
	459	if (pdev) {
	460	struct dsa_port_pdata *port_pdata;
	461
	462	port_pdata = dev_get_parent_plat(pdev);
4fdc7e35	463	strlcpy(port_pdata->name, name, DSA_PORT_NAME_LENGTH);
fc054d56 CM	464	pdev->name = port_pdata->name;
	465	}
	466
	467	/* try to bind all ports but keep 1st error */
	468	if (err && !first_err)
	469	first_err = err;
	470	}
	471
	472	if (first_err)
	473	return first_err;
	474
	475	dev_dbg(dev, "DSA ports successfully bound\n");
	476
	477	return 0;
	478	}
	479
	480	/**
	481	* Initialize the uclass per device internal state structure (priv).
	482	* TODO: pick up references to other switch devices here, if we're cascaded.
	483	*/
	484	static int dsa_pre_probe(struct udevice *dev)
	485	{
	486	struct dsa_pdata *pdata = dev_get_uclass_plat(dev);
	487	struct dsa_priv *priv = dev_get_uclass_priv(dev);
0fa4448d	488	int err;
fc054d56	489
fc054d56 CM	490	priv->num_ports = pdata->num_ports;
	491	priv->cpu_port = pdata->cpu_port;
	492	priv->cpu_port_fixed_phy = fixed_phy_create(pdata->cpu_port_node);
	493	if (!priv->cpu_port_fixed_phy) {
	494	dev_err(dev, "Failed to register fixed-link for CPU port\n");
	495	return -ENODEV;
	496	}
	497
2a5af404 SA	498	err = uclass_get_device_by_ofnode(UCLASS_ETH, pdata->master_node,
	499	&priv->master_dev);
	500	if (err)
	501	return err;
0fa4448d	502
c5868fcd TH	503	return 0;
	504	}
	505
	506	static int dsa_post_probe(struct udevice *dev)
	507	{
	508	struct dsa_priv *priv = dev_get_uclass_priv(dev);
	509	struct dsa_ops *ops = dsa_get_ops(dev);
	510	int err;
	511
0fa4448d VO	512	/* Simulate a probing event for the CPU port */
	513	if (ops->port_probe) {
	514	err = ops->port_probe(dev, priv->cpu_port,
	515	priv->cpu_port_fixed_phy);
	516	if (err)
	517	return err;
	518	}
	519
fc054d56 CM	520	return 0;
	521	}
	522
	523	UCLASS_DRIVER(dsa) = {
	524	.id = UCLASS_DSA,
	525	.name = "dsa",
	526	.post_bind = dsa_post_bind,
	527	.pre_probe = dsa_pre_probe,
c5868fcd	528	.post_probe = dsa_post_probe,
fc054d56 CM	529	.per_device_auto = sizeof(struct dsa_priv),
	530	.per_device_plat_auto = sizeof(struct dsa_pdata),
	531	.per_child_plat_auto = sizeof(struct dsa_port_pdata),
	532	.flags = DM_UC_FLAG_SEQ_ALIAS,
	533	};