1 // SPDX-License-Identifier: GPL-2.0
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
br_switchdev_mark_get(struct net_bridge * br,struct net_device * dev)11 static int br_switchdev_mark_get(struct net_bridge *br, struct net_device *dev)
12 {
13 struct net_bridge_port *p;
14
15 /* dev is yet to be added to the port list. */
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
nbp_switchdev_mark_set(struct net_bridge_port * p)24 int 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
nbp_switchdev_frame_mark(const struct net_bridge_port * p,struct sk_buff * skb)43 void 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
nbp_switchdev_allowed_egress(const struct net_bridge_port * p,const struct sk_buff * skb)50 bool 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 /* Flags that can be offloaded to hardware */
58 #define BR_PORT_FLAGS_HW_OFFLOAD (BR_LEARNING | BR_FLOOD | \
59 BR_MCAST_FLOOD | BR_BCAST_FLOOD)
60
br_switchdev_set_port_flag(struct net_bridge_port * p,unsigned long flags,unsigned long mask)61 int br_switchdev_set_port_flag(struct net_bridge_port *p,
62 unsigned long flags,
63 unsigned long mask)
64 {
65 struct switchdev_attr attr = {
66 .orig_dev = p->dev,
67 .id = SWITCHDEV_ATTR_ID_PORT_PRE_BRIDGE_FLAGS,
68 .u.brport_flags = mask,
69 };
70 struct switchdev_notifier_port_attr_info info = {
71 .attr = &attr,
72 };
73 int err;
74
75 if (mask & ~BR_PORT_FLAGS_HW_OFFLOAD)
76 return 0;
77
78 /* We run from atomic context here */
79 err = call_switchdev_notifiers(SWITCHDEV_PORT_ATTR_SET, p->dev,
80 &info.info, NULL);
81 err = notifier_to_errno(err);
82 if (err == -EOPNOTSUPP)
83 return 0;
84
85 if (err) {
86 br_warn(p->br, "bridge flag offload is not supported %u(%s)\n",
87 (unsigned int)p->port_no, p->dev->name);
88 return -EOPNOTSUPP;
89 }
90
91 attr.id = SWITCHDEV_ATTR_ID_PORT_BRIDGE_FLAGS;
92 attr.flags = SWITCHDEV_F_DEFER;
93 attr.u.brport_flags = flags;
94
95 err = switchdev_port_attr_set(p->dev, &attr);
96 if (err) {
97 br_warn(p->br, "error setting offload flag on port %u(%s)\n",
98 (unsigned int)p->port_no, p->dev->name);
99 return err;
100 }
101
102 return 0;
103 }
104
105 static void
br_switchdev_fdb_call_notifiers(bool adding,const unsigned char * mac,u16 vid,struct net_device * dev,bool added_by_user,bool offloaded)106 br_switchdev_fdb_call_notifiers(bool adding, const unsigned char *mac,
107 u16 vid, struct net_device *dev,
108 bool added_by_user, bool offloaded)
109 {
110 struct switchdev_notifier_fdb_info info;
111 unsigned long notifier_type;
112
113 info.addr = mac;
114 info.vid = vid;
115 info.added_by_user = added_by_user;
116 info.offloaded = offloaded;
117 notifier_type = adding ? SWITCHDEV_FDB_ADD_TO_DEVICE : SWITCHDEV_FDB_DEL_TO_DEVICE;
118 call_switchdev_notifiers(notifier_type, dev, &info.info, NULL);
119 }
120
121 void
br_switchdev_fdb_notify(const struct net_bridge_fdb_entry * fdb,int type)122 br_switchdev_fdb_notify(const struct net_bridge_fdb_entry *fdb, int type)
123 {
124 if (!fdb->dst)
125 return;
126 if (test_bit(BR_FDB_LOCAL, &fdb->flags))
127 return;
128
129 switch (type) {
130 case RTM_DELNEIGH:
131 br_switchdev_fdb_call_notifiers(false, fdb->key.addr.addr,
132 fdb->key.vlan_id,
133 fdb->dst->dev,
134 test_bit(BR_FDB_ADDED_BY_USER,
135 &fdb->flags),
136 test_bit(BR_FDB_OFFLOADED,
137 &fdb->flags));
138 break;
139 case RTM_NEWNEIGH:
140 br_switchdev_fdb_call_notifiers(true, fdb->key.addr.addr,
141 fdb->key.vlan_id,
142 fdb->dst->dev,
143 test_bit(BR_FDB_ADDED_BY_USER,
144 &fdb->flags),
145 test_bit(BR_FDB_OFFLOADED,
146 &fdb->flags));
147 break;
148 }
149 }
150
br_switchdev_port_vlan_add(struct net_device * dev,u16 vid,u16 flags,struct netlink_ext_ack * extack)151 int br_switchdev_port_vlan_add(struct net_device *dev, u16 vid, u16 flags,
152 struct netlink_ext_ack *extack)
153 {
154 struct switchdev_obj_port_vlan v = {
155 .obj.orig_dev = dev,
156 .obj.id = SWITCHDEV_OBJ_ID_PORT_VLAN,
157 .flags = flags,
158 .vid_begin = vid,
159 .vid_end = vid,
160 };
161
162 return switchdev_port_obj_add(dev, &v.obj, extack);
163 }
164
br_switchdev_port_vlan_del(struct net_device * dev,u16 vid)165 int br_switchdev_port_vlan_del(struct net_device *dev, u16 vid)
166 {
167 struct switchdev_obj_port_vlan v = {
168 .obj.orig_dev = dev,
169 .obj.id = SWITCHDEV_OBJ_ID_PORT_VLAN,
170 .vid_begin = vid,
171 .vid_end = vid,
172 };
173
174 return switchdev_port_obj_del(dev, &v.obj);
175 }
176