1
2#include <linux/kernel.h>
3#include <linux/list.h>
4#include <linux/netdevice.h>
5#include <linux/rtnetlink.h>
6#include <linux/skbuff.h>
7#include <net/switchdev.h>
8
9#include "br_private.h"
10
11static int br_switchdev_mark_get(struct net_bridge *br, struct net_device *dev)
12{
13 struct net_bridge_port *p;
14
15
16 list_for_each_entry(p, &br->port_list, list) {
17 if (switchdev_port_same_parent_id(dev, p->dev))
18 return p->offload_fwd_mark;
19 }
20
21 return ++br->offload_fwd_mark;
22}
23
24int nbp_switchdev_mark_set(struct net_bridge_port *p)
25{
26 struct switchdev_attr attr = {
27 .orig_dev = p->dev,
28 .id = SWITCHDEV_ATTR_ID_PORT_PARENT_ID,
29 };
30 int err;
31
32 ASSERT_RTNL();
33
34 err = switchdev_port_attr_get(p->dev, &attr);
35 if (err) {
36 if (err == -EOPNOTSUPP)
37 return 0;
38 return err;
39 }
40
41 p->offload_fwd_mark = br_switchdev_mark_get(p->br, p->dev);
42
43 return 0;
44}
45
46void nbp_switchdev_frame_mark(const struct net_bridge_port *p,
47 struct sk_buff *skb)
48{
49 if (skb->offload_fwd_mark && !WARN_ON_ONCE(!p->offload_fwd_mark))
50 BR_INPUT_SKB_CB(skb)->offload_fwd_mark = p->offload_fwd_mark;
51}
52
53bool nbp_switchdev_allowed_egress(const struct net_bridge_port *p,
54 const struct sk_buff *skb)
55{
56 return !skb->offload_fwd_mark ||
57 BR_INPUT_SKB_CB(skb)->offload_fwd_mark != p->offload_fwd_mark;
58}
59
60
61#define BR_PORT_FLAGS_HW_OFFLOAD (BR_LEARNING | BR_FLOOD | \
62 BR_MCAST_FLOOD | BR_BCAST_FLOOD)
63
64int br_switchdev_set_port_flag(struct net_bridge_port *p,
65 unsigned long flags,
66 unsigned long mask)
67{
68 struct switchdev_attr attr = {
69 .orig_dev = p->dev,
70 .id = SWITCHDEV_ATTR_ID_PORT_BRIDGE_FLAGS_SUPPORT,
71 };
72 int err;
73
74 if (mask & ~BR_PORT_FLAGS_HW_OFFLOAD)
75 return 0;
76
77 err = switchdev_port_attr_get(p->dev, &attr);
78 if (err == -EOPNOTSUPP)
79 return 0;
80 if (err)
81 return err;
82
83
84 if (!(attr.u.brport_flags_support & mask)) {
85 br_warn(p->br, "bridge flag offload is not supported %u(%s)\n",
86 (unsigned int)p->port_no, p->dev->name);
87 return -EOPNOTSUPP;
88 }
89
90 attr.id = SWITCHDEV_ATTR_ID_PORT_BRIDGE_FLAGS;
91 attr.flags = SWITCHDEV_F_DEFER;
92 attr.u.brport_flags = flags;
93 err = switchdev_port_attr_set(p->dev, &attr);
94 if (err) {
95 br_warn(p->br, "error setting offload flag on port %u(%s)\n",
96 (unsigned int)p->port_no, p->dev->name);
97 return err;
98 }
99
100 return 0;
101}
102
103static void
104br_switchdev_fdb_call_notifiers(bool adding, const unsigned char *mac,
105 u16 vid, struct net_device *dev,
106 bool added_by_user)
107{
108 struct switchdev_notifier_fdb_info info;
109 unsigned long notifier_type;
110
111 info.addr = mac;
112 info.vid = vid;
113 info.added_by_user = added_by_user;
114 notifier_type = adding ? SWITCHDEV_FDB_ADD_TO_DEVICE : SWITCHDEV_FDB_DEL_TO_DEVICE;
115 call_switchdev_notifiers(notifier_type, dev, &info.info);
116}
117
118void
119br_switchdev_fdb_notify(const struct net_bridge_fdb_entry *fdb, int type)
120{
121 if (!fdb->dst)
122 return;
123
124 switch (type) {
125 case RTM_DELNEIGH:
126 br_switchdev_fdb_call_notifiers(false, fdb->key.addr.addr,
127 fdb->key.vlan_id,
128 fdb->dst->dev,
129 fdb->added_by_user);
130 break;
131 case RTM_NEWNEIGH:
132 br_switchdev_fdb_call_notifiers(true, fdb->key.addr.addr,
133 fdb->key.vlan_id,
134 fdb->dst->dev,
135 fdb->added_by_user);
136 break;
137 }
138}
139
140int br_switchdev_port_vlan_add(struct net_device *dev, u16 vid, u16 flags)
141{
142 struct switchdev_obj_port_vlan v = {
143 .obj.orig_dev = dev,
144 .obj.id = SWITCHDEV_OBJ_ID_PORT_VLAN,
145 .flags = flags,
146 .vid_begin = vid,
147 .vid_end = vid,
148 };
149
150 return switchdev_port_obj_add(dev, &v.obj);
151}
152
153int br_switchdev_port_vlan_del(struct net_device *dev, u16 vid)
154{
155 struct switchdev_obj_port_vlan v = {
156 .obj.orig_dev = dev,
157 .obj.id = SWITCHDEV_OBJ_ID_PORT_VLAN,
158 .vid_begin = vid,
159 .vid_end = vid,
160 };
161
162 return switchdev_port_obj_del(dev, &v.obj);
163}
164