blob: ff442b8af636cd3c39ebe6e7547708744cd0416e [file] [log] [blame]
George McCollister54a52822021-01-14 13:57:32 -06001// 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
12static struct sk_buff *xrs700x_xmit(struct sk_buff *skb, struct net_device *dev)
13{
George McCollisterbd62e6f2021-02-09 19:02:13 -060014 struct dsa_port *partner, *dp = dsa_slave_to_port(dev);
George McCollister54a52822021-01-14 13:57:32 -060015 u8 *trailer;
16
17 trailer = skb_put(skb, 1);
18 trailer[0] = BIT(dp->index);
19
George McCollisterbd62e6f2021-02-09 19:02:13 -060020 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
George McCollister54a52822021-01-14 13:57:32 -060025 return skb;
26}
27
Vladimir Oltean29a097b2021-07-31 17:14:32 +030028static struct sk_buff *xrs700x_rcv(struct sk_buff *skb, struct net_device *dev)
George McCollister54a52822021-01-14 13:57:32 -060029{
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. */
Vladimir Olteanbea79072021-07-29 17:56:00 +030048 dsa_default_offload_fwd_mark(skb);
George McCollister54a52822021-01-14 13:57:32 -060049
50 return skb;
51}
52
53static 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,
Vladimir Oltean4e500252021-06-11 22:01:24 +030058 .needed_tailroom = 1,
George McCollister54a52822021-01-14 13:57:32 -060059};
60
61MODULE_LICENSE("GPL");
62MODULE_ALIAS_DSA_TAG_DRIVER(DSA_TAG_PROTO_XRS700X);
63
64module_dsa_tag_driver(xrs700x_netdev_ops);