[linux-2.6-block.git] / net / dsa / tag_xrs700x.c

// SPDX-License-Identifier: GPL-2.0+
/*
 * XRS700x tag format handling
 * Copyright (c) 2008-2009 Marvell Semiconductor
 * Copyright (c) 2020 NovaTech LLC
 */

#include <linux/bitops.h>

#include "dsa_priv.h"

static struct sk_buff *xrs700x_xmit(struct sk_buff *skb, struct net_device *dev)
{
	struct dsa_port *partner, *dp = dsa_slave_to_port(dev);
	u8 *trailer;

	trailer = skb_put(skb, 1);
	trailer[0] = BIT(dp->index);

	if (dp->hsr_dev)
		dsa_hsr_foreach_port(partner, dp->ds, dp->hsr_dev)
			if (partner != dp)
				trailer[0] |= BIT(partner->index);

	return skb;
}

static struct sk_buff *xrs700x_rcv(struct sk_buff *skb, struct net_device *dev)
{
	int source_port;
	u8 *trailer;

	trailer = skb_tail_pointer(skb) - 1;

	source_port = ffs((int)trailer[0]) - 1;

	if (source_port < 0)
		return NULL;

	skb->dev = dsa_master_find_slave(dev, 0, source_port);
	if (!skb->dev)
		return NULL;

	if (pskb_trim_rcsum(skb, skb->len - 1))
		return NULL;

	/* Frame is forwarded by hardware, don't forward in software. */
	dsa_default_offload_fwd_mark(skb);

	return skb;
}

static const struct dsa_device_ops xrs700x_netdev_ops = {
	.name	= "xrs700x",
	.proto	= DSA_TAG_PROTO_XRS700X,
	.xmit	= xrs700x_xmit,
	.rcv	= xrs700x_rcv,
	.needed_tailroom = 1,
};

MODULE_LICENSE("GPL");
MODULE_ALIAS_DSA_TAG_DRIVER(DSA_TAG_PROTO_XRS700X);

module_dsa_tag_driver(xrs700x_netdev_ops);
Commit	Line	Data
54a52823 GM	1	// SPDX-License-Identifier: GPL-2.0+
	2	/*
	3	* XRS700x tag format handling
	4	* Copyright (c) 2008-2009 Marvell Semiconductor
	5	* Copyright (c) 2020 NovaTech LLC
	6	*/
	7
	8	#include <linux/bitops.h>
	9
	10	#include "dsa_priv.h"
	11
	12	static struct sk_buff xrs700x_xmit(struct sk_buff skb, struct net_device *dev)
	13	{
bd62e6f5	14	struct dsa_port partner, dp = dsa_slave_to_port(dev);
54a52823 GM	15	u8 *trailer;
	16
	17	trailer = skb_put(skb, 1);
	18	trailer[0] = BIT(dp->index);
	19
bd62e6f5 GM	20	if (dp->hsr_dev)
	21	dsa_hsr_foreach_port(partner, dp->ds, dp->hsr_dev)
	22	if (partner != dp)
	23	trailer[0] \|= BIT(partner->index);
	24
54a52823 GM	25	return skb;
	26	}
	27
29a097b7	28	static struct sk_buff xrs700x_rcv(struct sk_buff skb, struct net_device *dev)
54a52823 GM	29	{
	30	int source_port;
	31	u8 *trailer;
	32
	33	trailer = skb_tail_pointer(skb) - 1;
	34
	35	source_port = ffs((int)trailer[0]) - 1;
	36
	37	if (source_port < 0)
	38	return NULL;
	39
	40	skb->dev = dsa_master_find_slave(dev, 0, source_port);
	41	if (!skb->dev)
	42	return NULL;
	43
	44	if (pskb_trim_rcsum(skb, skb->len - 1))
	45	return NULL;
	46
	47	/* Frame is forwarded by hardware, don't forward in software. */
bea79078	48	dsa_default_offload_fwd_mark(skb);
54a52823 GM	49
	50	return skb;
	51	}
	52
	53	static const struct dsa_device_ops xrs700x_netdev_ops = {
	54	.name = "xrs700x",
	55	.proto = DSA_TAG_PROTO_XRS700X,
	56	.xmit = xrs700x_xmit,
	57	.rcv = xrs700x_rcv,
4e500251	58	.needed_tailroom = 1,
54a52823 GM	59	};
	60
	61	MODULE_LICENSE("GPL");
	62	MODULE_ALIAS_DSA_TAG_DRIVER(DSA_TAG_PROTO_XRS700X);
	63
	64	module_dsa_tag_driver(xrs700x_netdev_ops);