Donate to e Foundation | Murena handsets with /e/OS | Own a part of Murena! Learn more

Commit 339d8262 authored by Guenter Roeck's avatar Guenter Roeck Committed by David S. Miller
Browse files

net: dsa: Add basic framework to support ndo_fdb functions 



Provide callbacks for ndo_fdb_add, ndo_fdb_del, and ndo_fdb_dump.

Reviewed-by: default avatarAndrew Lunn <andrew@lunn.ch>
Tested-by: default avatarAndrew Lunn <andrew@lunn.ch>
Signed-off-by: default avatarGuenter Roeck <linux@roeck-us.net>
Signed-off-by: default avatarDavid S. Miller <davem@davemloft.net>
parent 3f244abb

include/net/dsa.h

+6 −0
Original line number Diff line number Diff line
@@ -296,6 +296,12 @@ struct dsa_switch_driver { 
				     u32 br_port_mask);

	int	(*port_stp_update)(struct dsa_switch *ds, int port,

				   u8 state);

	int	(*fdb_add)(struct dsa_switch *ds, int port,

			   const unsigned char *addr, u16 vid);

	int	(*fdb_del)(struct dsa_switch *ds, int port,

			   const unsigned char *addr, u16 vid);

	int	(*fdb_getnext)(struct dsa_switch *ds, int port,

			       unsigned char *addr, bool *is_static);

};



void register_switch_driver(struct dsa_switch_driver *type);

net/dsa/slave.c

+102 −0
Original line number Diff line number Diff line
@@ -201,6 +201,105 @@ static int dsa_slave_set_mac_address(struct net_device *dev, void *a) 
	return 0;

}



static int dsa_slave_fdb_add(struct ndmsg *ndm, struct nlattr *tb[],

			     struct net_device *dev,

			     const unsigned char *addr, u16 vid, u16 nlm_flags)

{

	struct dsa_slave_priv *p = netdev_priv(dev);

	struct dsa_switch *ds = p->parent;

	int ret = -EOPNOTSUPP;



	if (ds->drv->fdb_add)

		ret = ds->drv->fdb_add(ds, p->port, addr, vid);



	return ret;

}



static int dsa_slave_fdb_del(struct ndmsg *ndm, struct nlattr *tb[],

			     struct net_device *dev,

			     const unsigned char *addr, u16 vid)

{

	struct dsa_slave_priv *p = netdev_priv(dev);

	struct dsa_switch *ds = p->parent;

	int ret = -EOPNOTSUPP;



	if (ds->drv->fdb_del)

		ret = ds->drv->fdb_del(ds, p->port, addr, vid);



	return ret;

}



static int dsa_slave_fill_info(struct net_device *dev, struct sk_buff *skb,

			       const unsigned char *addr, u16 vid,

			       bool is_static,

			       u32 portid, u32 seq, int type,

			       unsigned int flags)

{

	struct nlmsghdr *nlh;

	struct ndmsg *ndm;



	nlh = nlmsg_put(skb, portid, seq, type, sizeof(*ndm), flags);

	if (!nlh)

		return -EMSGSIZE;



	ndm = nlmsg_data(nlh);

	ndm->ndm_family	 = AF_BRIDGE;

	ndm->ndm_pad1    = 0;

	ndm->ndm_pad2    = 0;

	ndm->ndm_flags	 = NTF_EXT_LEARNED;

	ndm->ndm_type	 = 0;

	ndm->ndm_ifindex = dev->ifindex;

	ndm->ndm_state   = is_static ? NUD_NOARP : NUD_REACHABLE;



	if (nla_put(skb, NDA_LLADDR, ETH_ALEN, addr))

		goto nla_put_failure;



	if (vid && nla_put_u16(skb, NDA_VLAN, vid))

		goto nla_put_failure;



	nlmsg_end(skb, nlh);

	return 0;



nla_put_failure:

	nlmsg_cancel(skb, nlh);

	return -EMSGSIZE;

}



/* Dump information about entries, in response to GETNEIGH */

static int dsa_slave_fdb_dump(struct sk_buff *skb, struct netlink_callback *cb,

			      struct net_device *dev,

			      struct net_device *filter_dev, int idx)

{

	struct dsa_slave_priv *p = netdev_priv(dev);

	struct dsa_switch *ds = p->parent;

	unsigned char addr[ETH_ALEN] = { 0 };

	int ret;



	if (!ds->drv->fdb_getnext)

		return -EOPNOTSUPP;



	for (; ; idx++) {

		bool is_static;



		ret = ds->drv->fdb_getnext(ds, p->port, addr, &is_static);

		if (ret < 0)

			break;



		if (idx < cb->args[0])

			continue;



		ret = dsa_slave_fill_info(dev, skb, addr, 0,

					  is_static,

					  NETLINK_CB(cb->skb).portid,

					  cb->nlh->nlmsg_seq,

					  RTM_NEWNEIGH, NLM_F_MULTI);

		if (ret < 0)

			break;

	}



	return idx;

}



static int dsa_slave_ioctl(struct net_device *dev, struct ifreq *ifr, int cmd)

{

	struct dsa_slave_priv *p = netdev_priv(dev);
@@ -572,6 +671,9 @@ static const struct net_device_ops dsa_slave_netdev_ops = { 
	.ndo_change_rx_flags	= dsa_slave_change_rx_flags,

	.ndo_set_rx_mode	= dsa_slave_set_rx_mode,

	.ndo_set_mac_address	= dsa_slave_set_mac_address,

	.ndo_fdb_add		= dsa_slave_fdb_add,

	.ndo_fdb_del		= dsa_slave_fdb_del,

	.ndo_fdb_dump		= dsa_slave_fdb_dump,

	.ndo_do_ioctl		= dsa_slave_ioctl,

};