1*6bc506b4SIdo Schimmel #include <linux/kernel.h> 2*6bc506b4SIdo Schimmel #include <linux/list.h> 3*6bc506b4SIdo Schimmel #include <linux/netdevice.h> 4*6bc506b4SIdo Schimmel #include <linux/rtnetlink.h> 5*6bc506b4SIdo Schimmel #include <linux/skbuff.h> 6*6bc506b4SIdo Schimmel #include <net/switchdev.h> 7*6bc506b4SIdo Schimmel 8*6bc506b4SIdo Schimmel #include "br_private.h" 9*6bc506b4SIdo Schimmel 10*6bc506b4SIdo Schimmel static int br_switchdev_mark_get(struct net_bridge *br, struct net_device *dev) 11*6bc506b4SIdo Schimmel { 12*6bc506b4SIdo Schimmel struct net_bridge_port *p; 13*6bc506b4SIdo Schimmel 14*6bc506b4SIdo Schimmel /* dev is yet to be added to the port list. */ 15*6bc506b4SIdo Schimmel list_for_each_entry(p, &br->port_list, list) { 16*6bc506b4SIdo Schimmel if (switchdev_port_same_parent_id(dev, p->dev)) 17*6bc506b4SIdo Schimmel return p->offload_fwd_mark; 18*6bc506b4SIdo Schimmel } 19*6bc506b4SIdo Schimmel 20*6bc506b4SIdo Schimmel return ++br->offload_fwd_mark; 21*6bc506b4SIdo Schimmel } 22*6bc506b4SIdo Schimmel 23*6bc506b4SIdo Schimmel int nbp_switchdev_mark_set(struct net_bridge_port *p) 24*6bc506b4SIdo Schimmel { 25*6bc506b4SIdo Schimmel struct switchdev_attr attr = { 26*6bc506b4SIdo Schimmel .orig_dev = p->dev, 27*6bc506b4SIdo Schimmel .id = SWITCHDEV_ATTR_ID_PORT_PARENT_ID, 28*6bc506b4SIdo Schimmel }; 29*6bc506b4SIdo Schimmel int err; 30*6bc506b4SIdo Schimmel 31*6bc506b4SIdo Schimmel ASSERT_RTNL(); 32*6bc506b4SIdo Schimmel 33*6bc506b4SIdo Schimmel err = switchdev_port_attr_get(p->dev, &attr); 34*6bc506b4SIdo Schimmel if (err) { 35*6bc506b4SIdo Schimmel if (err == -EOPNOTSUPP) 36*6bc506b4SIdo Schimmel return 0; 37*6bc506b4SIdo Schimmel return err; 38*6bc506b4SIdo Schimmel } 39*6bc506b4SIdo Schimmel 40*6bc506b4SIdo Schimmel p->offload_fwd_mark = br_switchdev_mark_get(p->br, p->dev); 41*6bc506b4SIdo Schimmel 42*6bc506b4SIdo Schimmel return 0; 43*6bc506b4SIdo Schimmel } 44*6bc506b4SIdo Schimmel 45*6bc506b4SIdo Schimmel void nbp_switchdev_frame_mark(const struct net_bridge_port *p, 46*6bc506b4SIdo Schimmel struct sk_buff *skb) 47*6bc506b4SIdo Schimmel { 48*6bc506b4SIdo Schimmel if (skb->offload_fwd_mark && !WARN_ON_ONCE(!p->offload_fwd_mark)) 49*6bc506b4SIdo Schimmel BR_INPUT_SKB_CB(skb)->offload_fwd_mark = p->offload_fwd_mark; 50*6bc506b4SIdo Schimmel } 51*6bc506b4SIdo Schimmel 52*6bc506b4SIdo Schimmel bool nbp_switchdev_allowed_egress(const struct net_bridge_port *p, 53*6bc506b4SIdo Schimmel const struct sk_buff *skb) 54*6bc506b4SIdo Schimmel { 55*6bc506b4SIdo Schimmel return !skb->offload_fwd_mark || 56*6bc506b4SIdo Schimmel BR_INPUT_SKB_CB(skb)->offload_fwd_mark != p->offload_fwd_mark; 57*6bc506b4SIdo Schimmel } 58