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 (netdev_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 netdev_phys_item_id ppid = { };
27 int err;
28
29 ASSERT_RTNL();
30
31 err = dev_get_port_parent_id(p->dev, &ppid, true);
32 if (err) {
33 if (err == -EOPNOTSUPP)
34 return 0;
35 return err;
36 }
37
38 p->offload_fwd_mark = br_switchdev_mark_get(p->br, p->dev);
39
40 return 0;
41}
42
43void nbp_switchdev_frame_mark(const struct net_bridge_port *p,
44 struct sk_buff *skb)
45{
46 if (skb->offload_fwd_mark && !WARN_ON_ONCE(!p->offload_fwd_mark))
47 BR_INPUT_SKB_CB(skb)->offload_fwd_mark = p->offload_fwd_mark;
48}
49
50bool nbp_switchdev_allowed_egress(const struct net_bridge_port *p,
51 const struct sk_buff *skb)
52{
53 return !skb->offload_fwd_mark ||
54 BR_INPUT_SKB_CB(skb)->offload_fwd_mark != p->offload_fwd_mark;
55}
56
57
58#define BR_PORT_FLAGS_HW_OFFLOAD (BR_LEARNING | BR_FLOOD | \
59 BR_MCAST_FLOOD | BR_BCAST_FLOOD)
60
61int br_switchdev_set_port_flag(struct net_bridge_port *p,
62 unsigned long flags,
63 unsigned long mask,
64 struct netlink_ext_ack *extack)
65{
66 struct switchdev_attr attr = {
67 .orig_dev = p->dev,
68 };
69 struct switchdev_notifier_port_attr_info info = {
70 .attr = &attr,
71 };
72 int err;
73
74 mask &= BR_PORT_FLAGS_HW_OFFLOAD;
75 if (!mask)
76 return 0;
77
78 attr.id = SWITCHDEV_ATTR_ID_PORT_PRE_BRIDGE_FLAGS;
79 attr.u.brport_flags.val = flags;
80 attr.u.brport_flags.mask = mask;
81
82
83 err = call_switchdev_notifiers(SWITCHDEV_PORT_ATTR_SET, p->dev,
84 &info.info, extack);
85 err = notifier_to_errno(err);
86 if (err == -EOPNOTSUPP)
87 return 0;
88
89 if (err) {
90 if (extack && !extack->_msg)
91 NL_SET_ERR_MSG_MOD(extack,
92 "bridge flag offload is not supported");
93 return -EOPNOTSUPP;
94 }
95
96 attr.id = SWITCHDEV_ATTR_ID_PORT_BRIDGE_FLAGS;
97 attr.flags = SWITCHDEV_F_DEFER;
98
99 err = switchdev_port_attr_set(p->dev, &attr, extack);
100 if (err) {
101 if (extack && !extack->_msg)
102 NL_SET_ERR_MSG_MOD(extack,
103 "error setting offload flag on port");
104 return err;
105 }
106
107 return 0;
108}
109
110static void
111br_switchdev_fdb_call_notifiers(bool adding, const unsigned char *mac,
112 u16 vid, struct net_device *dev,
113 bool added_by_user, bool offloaded)
114{
115 struct switchdev_notifier_fdb_info info;
116 unsigned long notifier_type;
117
118 info.addr = mac;
119 info.vid = vid;
120 info.added_by_user = added_by_user;
121 info.offloaded = offloaded;
122 notifier_type = adding ? SWITCHDEV_FDB_ADD_TO_DEVICE : SWITCHDEV_FDB_DEL_TO_DEVICE;
123 call_switchdev_notifiers(notifier_type, dev, &info.info, NULL);
124}
125
126void
127br_switchdev_fdb_notify(const struct net_bridge_fdb_entry *fdb, int type)
128{
129 if (!fdb->dst)
130 return;
131 if (test_bit(BR_FDB_LOCAL, &fdb->flags))
132 return;
133
134 switch (type) {
135 case RTM_DELNEIGH:
136 br_switchdev_fdb_call_notifiers(false, fdb->key.addr.addr,
137 fdb->key.vlan_id,
138 fdb->dst->dev,
139 test_bit(BR_FDB_ADDED_BY_USER,
140 &fdb->flags),
141 test_bit(BR_FDB_OFFLOADED,
142 &fdb->flags));
143 break;
144 case RTM_NEWNEIGH:
145 br_switchdev_fdb_call_notifiers(true, fdb->key.addr.addr,
146 fdb->key.vlan_id,
147 fdb->dst->dev,
148 test_bit(BR_FDB_ADDED_BY_USER,
149 &fdb->flags),
150 test_bit(BR_FDB_OFFLOADED,
151 &fdb->flags));
152 break;
153 }
154}
155
156int br_switchdev_port_vlan_add(struct net_device *dev, u16 vid, u16 flags,
157 struct netlink_ext_ack *extack)
158{
159 struct switchdev_obj_port_vlan v = {
160 .obj.orig_dev = dev,
161 .obj.id = SWITCHDEV_OBJ_ID_PORT_VLAN,
162 .flags = flags,
163 .vid = vid,
164 };
165
166 return switchdev_port_obj_add(dev, &v.obj, extack);
167}
168
169int br_switchdev_port_vlan_del(struct net_device *dev, u16 vid)
170{
171 struct switchdev_obj_port_vlan v = {
172 .obj.orig_dev = dev,
173 .obj.id = SWITCHDEV_OBJ_ID_PORT_VLAN,
174 .vid = vid,
175 };
176
177 return switchdev_port_obj_del(dev, &v.obj);
178}
179
