mirror of
				https://github.com/torvalds/linux.git
				synced 2025-11-04 10:40:15 +02:00 
			
		
		
		
	net: dsa: add MRP support
Add support for offloading MRP in HW. Currently implement the switchdev calls 'SWITCHDEV_OBJ_ID_MRP', 'SWITCHDEV_OBJ_ID_RING_ROLE_MRP', to allow to create MRP instances and to set the role of these instances. Add DSA_NOTIFIER_MRP_ADD/DEL and DSA_NOTIFIER_MRP_ADD/DEL_RING_ROLE which calls to .port_mrp_add/del and .port_mrp_add/del_ring_role in the DSA driver for the switch. Signed-off-by: Horatiu Vultur <horatiu.vultur@microchip.com> Signed-off-by: David S. Miller <davem@davemloft.net>
This commit is contained in:
		
							parent
							
								
									d8ea7ff399
								
							
						
					
					
						commit
						c595c4330d
					
				
					 5 changed files with 213 additions and 0 deletions
				
			
		| 
						 | 
				
			
			@ -792,6 +792,18 @@ struct dsa_switch_ops {
 | 
			
		|||
				 struct net_device *hsr);
 | 
			
		||||
	int	(*port_hsr_leave)(struct dsa_switch *ds, int port,
 | 
			
		||||
				  struct net_device *hsr);
 | 
			
		||||
 | 
			
		||||
	/*
 | 
			
		||||
	 * MRP integration
 | 
			
		||||
	 */
 | 
			
		||||
	int	(*port_mrp_add)(struct dsa_switch *ds, int port,
 | 
			
		||||
				const struct switchdev_obj_mrp *mrp);
 | 
			
		||||
	int	(*port_mrp_del)(struct dsa_switch *ds, int port,
 | 
			
		||||
				const struct switchdev_obj_mrp *mrp);
 | 
			
		||||
	int	(*port_mrp_add_ring_role)(struct dsa_switch *ds, int port,
 | 
			
		||||
					  const struct switchdev_obj_ring_role_mrp *mrp);
 | 
			
		||||
	int	(*port_mrp_del_ring_role)(struct dsa_switch *ds, int port,
 | 
			
		||||
					  const struct switchdev_obj_ring_role_mrp *mrp);
 | 
			
		||||
};
 | 
			
		||||
 | 
			
		||||
#define DSA_DEVLINK_PARAM_DRIVER(_id, _name, _type, _cmodes)		\
 | 
			
		||||
| 
						 | 
				
			
			
 | 
			
		|||
| 
						 | 
				
			
			@ -31,6 +31,10 @@ enum {
 | 
			
		|||
	DSA_NOTIFIER_VLAN_DEL,
 | 
			
		||||
	DSA_NOTIFIER_MTU,
 | 
			
		||||
	DSA_NOTIFIER_TAG_PROTO,
 | 
			
		||||
	DSA_NOTIFIER_MRP_ADD,
 | 
			
		||||
	DSA_NOTIFIER_MRP_DEL,
 | 
			
		||||
	DSA_NOTIFIER_MRP_ADD_RING_ROLE,
 | 
			
		||||
	DSA_NOTIFIER_MRP_DEL_RING_ROLE,
 | 
			
		||||
};
 | 
			
		||||
 | 
			
		||||
/* DSA_NOTIFIER_AGEING_TIME */
 | 
			
		||||
| 
						 | 
				
			
			@ -91,6 +95,20 @@ struct dsa_notifier_tag_proto_info {
 | 
			
		|||
	const struct dsa_device_ops *tag_ops;
 | 
			
		||||
};
 | 
			
		||||
 | 
			
		||||
/* DSA_NOTIFIER_MRP_* */
 | 
			
		||||
struct dsa_notifier_mrp_info {
 | 
			
		||||
	const struct switchdev_obj_mrp *mrp;
 | 
			
		||||
	int sw_index;
 | 
			
		||||
	int port;
 | 
			
		||||
};
 | 
			
		||||
 | 
			
		||||
/* DSA_NOTIFIER_MRP_* */
 | 
			
		||||
struct dsa_notifier_mrp_ring_role_info {
 | 
			
		||||
	const struct switchdev_obj_ring_role_mrp *mrp;
 | 
			
		||||
	int sw_index;
 | 
			
		||||
	int port;
 | 
			
		||||
};
 | 
			
		||||
 | 
			
		||||
struct dsa_switchdev_event_work {
 | 
			
		||||
	struct dsa_switch *ds;
 | 
			
		||||
	int port;
 | 
			
		||||
| 
						 | 
				
			
			@ -198,6 +216,14 @@ int dsa_port_vlan_add(struct dsa_port *dp,
 | 
			
		|||
		      struct netlink_ext_ack *extack);
 | 
			
		||||
int dsa_port_vlan_del(struct dsa_port *dp,
 | 
			
		||||
		      const struct switchdev_obj_port_vlan *vlan);
 | 
			
		||||
int dsa_port_mrp_add(const struct dsa_port *dp,
 | 
			
		||||
		     const struct switchdev_obj_mrp *mrp);
 | 
			
		||||
int dsa_port_mrp_del(const struct dsa_port *dp,
 | 
			
		||||
		     const struct switchdev_obj_mrp *mrp);
 | 
			
		||||
int dsa_port_mrp_add_ring_role(const struct dsa_port *dp,
 | 
			
		||||
			       const struct switchdev_obj_ring_role_mrp *mrp);
 | 
			
		||||
int dsa_port_mrp_del_ring_role(const struct dsa_port *dp,
 | 
			
		||||
			       const struct switchdev_obj_ring_role_mrp *mrp);
 | 
			
		||||
int dsa_port_link_register_of(struct dsa_port *dp);
 | 
			
		||||
void dsa_port_link_unregister_of(struct dsa_port *dp);
 | 
			
		||||
int dsa_port_hsr_join(struct dsa_port *dp, struct net_device *hsr);
 | 
			
		||||
| 
						 | 
				
			
			
 | 
			
		|||
| 
						 | 
				
			
			@ -564,6 +564,54 @@ int dsa_port_vlan_del(struct dsa_port *dp,
 | 
			
		|||
	return dsa_port_notify(dp, DSA_NOTIFIER_VLAN_DEL, &info);
 | 
			
		||||
}
 | 
			
		||||
 | 
			
		||||
int dsa_port_mrp_add(const struct dsa_port *dp,
 | 
			
		||||
		     const struct switchdev_obj_mrp *mrp)
 | 
			
		||||
{
 | 
			
		||||
	struct dsa_notifier_mrp_info info = {
 | 
			
		||||
		.sw_index = dp->ds->index,
 | 
			
		||||
		.port = dp->index,
 | 
			
		||||
		.mrp = mrp,
 | 
			
		||||
	};
 | 
			
		||||
 | 
			
		||||
	return dsa_port_notify(dp, DSA_NOTIFIER_MRP_ADD, &info);
 | 
			
		||||
}
 | 
			
		||||
 | 
			
		||||
int dsa_port_mrp_del(const struct dsa_port *dp,
 | 
			
		||||
		     const struct switchdev_obj_mrp *mrp)
 | 
			
		||||
{
 | 
			
		||||
	struct dsa_notifier_mrp_info info = {
 | 
			
		||||
		.sw_index = dp->ds->index,
 | 
			
		||||
		.port = dp->index,
 | 
			
		||||
		.mrp = mrp,
 | 
			
		||||
	};
 | 
			
		||||
 | 
			
		||||
	return dsa_port_notify(dp, DSA_NOTIFIER_MRP_DEL, &info);
 | 
			
		||||
}
 | 
			
		||||
 | 
			
		||||
int dsa_port_mrp_add_ring_role(const struct dsa_port *dp,
 | 
			
		||||
			       const struct switchdev_obj_ring_role_mrp *mrp)
 | 
			
		||||
{
 | 
			
		||||
	struct dsa_notifier_mrp_ring_role_info info = {
 | 
			
		||||
		.sw_index = dp->ds->index,
 | 
			
		||||
		.port = dp->index,
 | 
			
		||||
		.mrp = mrp,
 | 
			
		||||
	};
 | 
			
		||||
 | 
			
		||||
	return dsa_port_notify(dp, DSA_NOTIFIER_MRP_ADD_RING_ROLE, &info);
 | 
			
		||||
}
 | 
			
		||||
 | 
			
		||||
int dsa_port_mrp_del_ring_role(const struct dsa_port *dp,
 | 
			
		||||
			       const struct switchdev_obj_ring_role_mrp *mrp)
 | 
			
		||||
{
 | 
			
		||||
	struct dsa_notifier_mrp_ring_role_info info = {
 | 
			
		||||
		.sw_index = dp->ds->index,
 | 
			
		||||
		.port = dp->index,
 | 
			
		||||
		.mrp = mrp,
 | 
			
		||||
	};
 | 
			
		||||
 | 
			
		||||
	return dsa_port_notify(dp, DSA_NOTIFIER_MRP_DEL_RING_ROLE, &info);
 | 
			
		||||
}
 | 
			
		||||
 | 
			
		||||
void dsa_port_set_tag_protocol(struct dsa_port *cpu_dp,
 | 
			
		||||
			       const struct dsa_device_ops *tag_ops)
 | 
			
		||||
{
 | 
			
		||||
| 
						 | 
				
			
			
 | 
			
		|||
| 
						 | 
				
			
			@ -404,6 +404,17 @@ static int dsa_slave_port_obj_add(struct net_device *dev,
 | 
			
		|||
	case SWITCHDEV_OBJ_ID_PORT_VLAN:
 | 
			
		||||
		err = dsa_slave_vlan_add(dev, obj, extack);
 | 
			
		||||
		break;
 | 
			
		||||
	case SWITCHDEV_OBJ_ID_MRP:
 | 
			
		||||
		if (!dsa_port_offloads_netdev(dp, obj->orig_dev))
 | 
			
		||||
			return -EOPNOTSUPP;
 | 
			
		||||
		err = dsa_port_mrp_add(dp, SWITCHDEV_OBJ_MRP(obj));
 | 
			
		||||
		break;
 | 
			
		||||
	case SWITCHDEV_OBJ_ID_RING_ROLE_MRP:
 | 
			
		||||
		if (!dsa_port_offloads_netdev(dp, obj->orig_dev))
 | 
			
		||||
			return -EOPNOTSUPP;
 | 
			
		||||
		err = dsa_port_mrp_add_ring_role(dp,
 | 
			
		||||
						 SWITCHDEV_OBJ_RING_ROLE_MRP(obj));
 | 
			
		||||
		break;
 | 
			
		||||
	default:
 | 
			
		||||
		err = -EOPNOTSUPP;
 | 
			
		||||
		break;
 | 
			
		||||
| 
						 | 
				
			
			@ -461,6 +472,17 @@ static int dsa_slave_port_obj_del(struct net_device *dev,
 | 
			
		|||
	case SWITCHDEV_OBJ_ID_PORT_VLAN:
 | 
			
		||||
		err = dsa_slave_vlan_del(dev, obj);
 | 
			
		||||
		break;
 | 
			
		||||
	case SWITCHDEV_OBJ_ID_MRP:
 | 
			
		||||
		if (!dsa_port_offloads_netdev(dp, obj->orig_dev))
 | 
			
		||||
			return -EOPNOTSUPP;
 | 
			
		||||
		err = dsa_port_mrp_del(dp, SWITCHDEV_OBJ_MRP(obj));
 | 
			
		||||
		break;
 | 
			
		||||
	case SWITCHDEV_OBJ_ID_RING_ROLE_MRP:
 | 
			
		||||
		if (!dsa_port_offloads_netdev(dp, obj->orig_dev))
 | 
			
		||||
			return -EOPNOTSUPP;
 | 
			
		||||
		err = dsa_port_mrp_del_ring_role(dp,
 | 
			
		||||
						 SWITCHDEV_OBJ_RING_ROLE_MRP(obj));
 | 
			
		||||
		break;
 | 
			
		||||
	default:
 | 
			
		||||
		err = -EOPNOTSUPP;
 | 
			
		||||
		break;
 | 
			
		||||
| 
						 | 
				
			
			
 | 
			
		|||
							
								
								
									
										105
									
								
								net/dsa/switch.c
									
									
									
									
									
								
							
							
						
						
									
										105
									
								
								net/dsa/switch.c
									
									
									
									
									
								
							| 
						 | 
				
			
			@ -372,6 +372,99 @@ static int dsa_switch_change_tag_proto(struct dsa_switch *ds,
 | 
			
		|||
	return 0;
 | 
			
		||||
}
 | 
			
		||||
 | 
			
		||||
static bool dsa_switch_mrp_match(struct dsa_switch *ds, int port,
 | 
			
		||||
				 struct dsa_notifier_mrp_info *info)
 | 
			
		||||
{
 | 
			
		||||
	if (ds->index == info->sw_index && port == info->port)
 | 
			
		||||
		return true;
 | 
			
		||||
 | 
			
		||||
	if (dsa_is_dsa_port(ds, port))
 | 
			
		||||
		return true;
 | 
			
		||||
 | 
			
		||||
	return false;
 | 
			
		||||
}
 | 
			
		||||
 | 
			
		||||
static int dsa_switch_mrp_add(struct dsa_switch *ds,
 | 
			
		||||
			      struct dsa_notifier_mrp_info *info)
 | 
			
		||||
{
 | 
			
		||||
	int err = 0;
 | 
			
		||||
	int port;
 | 
			
		||||
 | 
			
		||||
	if (!ds->ops->port_mrp_add)
 | 
			
		||||
		return -EOPNOTSUPP;
 | 
			
		||||
 | 
			
		||||
	for (port = 0; port < ds->num_ports; port++) {
 | 
			
		||||
		if (dsa_switch_mrp_match(ds, port, info)) {
 | 
			
		||||
			err = ds->ops->port_mrp_add(ds, port, info->mrp);
 | 
			
		||||
			if (err)
 | 
			
		||||
				break;
 | 
			
		||||
		}
 | 
			
		||||
	}
 | 
			
		||||
 | 
			
		||||
	return err;
 | 
			
		||||
}
 | 
			
		||||
 | 
			
		||||
static int dsa_switch_mrp_del(struct dsa_switch *ds,
 | 
			
		||||
			      struct dsa_notifier_mrp_info *info)
 | 
			
		||||
{
 | 
			
		||||
	if (!ds->ops->port_mrp_del)
 | 
			
		||||
		return -EOPNOTSUPP;
 | 
			
		||||
 | 
			
		||||
	if (ds->index == info->sw_index)
 | 
			
		||||
		return ds->ops->port_mrp_del(ds, info->port, info->mrp);
 | 
			
		||||
 | 
			
		||||
	return 0;
 | 
			
		||||
}
 | 
			
		||||
 | 
			
		||||
static bool
 | 
			
		||||
dsa_switch_mrp_ring_role_match(struct dsa_switch *ds, int port,
 | 
			
		||||
			       struct dsa_notifier_mrp_ring_role_info *info)
 | 
			
		||||
{
 | 
			
		||||
	if (ds->index == info->sw_index && port == info->port)
 | 
			
		||||
		return true;
 | 
			
		||||
 | 
			
		||||
	if (dsa_is_dsa_port(ds, port))
 | 
			
		||||
		return true;
 | 
			
		||||
 | 
			
		||||
	return false;
 | 
			
		||||
}
 | 
			
		||||
 | 
			
		||||
static int
 | 
			
		||||
dsa_switch_mrp_add_ring_role(struct dsa_switch *ds,
 | 
			
		||||
			     struct dsa_notifier_mrp_ring_role_info *info)
 | 
			
		||||
{
 | 
			
		||||
	int err = 0;
 | 
			
		||||
	int port;
 | 
			
		||||
 | 
			
		||||
	if (!ds->ops->port_mrp_add)
 | 
			
		||||
		return -EOPNOTSUPP;
 | 
			
		||||
 | 
			
		||||
	for (port = 0; port < ds->num_ports; port++) {
 | 
			
		||||
		if (dsa_switch_mrp_ring_role_match(ds, port, info)) {
 | 
			
		||||
			err = ds->ops->port_mrp_add_ring_role(ds, port,
 | 
			
		||||
							      info->mrp);
 | 
			
		||||
			if (err)
 | 
			
		||||
				break;
 | 
			
		||||
		}
 | 
			
		||||
	}
 | 
			
		||||
 | 
			
		||||
	return err;
 | 
			
		||||
}
 | 
			
		||||
 | 
			
		||||
static int
 | 
			
		||||
dsa_switch_mrp_del_ring_role(struct dsa_switch *ds,
 | 
			
		||||
			     struct dsa_notifier_mrp_ring_role_info *info)
 | 
			
		||||
{
 | 
			
		||||
	if (!ds->ops->port_mrp_del)
 | 
			
		||||
		return -EOPNOTSUPP;
 | 
			
		||||
 | 
			
		||||
	if (ds->index == info->sw_index)
 | 
			
		||||
		return ds->ops->port_mrp_del_ring_role(ds, info->port,
 | 
			
		||||
						       info->mrp);
 | 
			
		||||
 | 
			
		||||
	return 0;
 | 
			
		||||
}
 | 
			
		||||
 | 
			
		||||
static int dsa_switch_event(struct notifier_block *nb,
 | 
			
		||||
			    unsigned long event, void *info)
 | 
			
		||||
{
 | 
			
		||||
| 
						 | 
				
			
			@ -427,6 +520,18 @@ static int dsa_switch_event(struct notifier_block *nb,
 | 
			
		|||
	case DSA_NOTIFIER_TAG_PROTO:
 | 
			
		||||
		err = dsa_switch_change_tag_proto(ds, info);
 | 
			
		||||
		break;
 | 
			
		||||
	case DSA_NOTIFIER_MRP_ADD:
 | 
			
		||||
		err = dsa_switch_mrp_add(ds, info);
 | 
			
		||||
		break;
 | 
			
		||||
	case DSA_NOTIFIER_MRP_DEL:
 | 
			
		||||
		err = dsa_switch_mrp_del(ds, info);
 | 
			
		||||
		break;
 | 
			
		||||
	case DSA_NOTIFIER_MRP_ADD_RING_ROLE:
 | 
			
		||||
		err = dsa_switch_mrp_add_ring_role(ds, info);
 | 
			
		||||
		break;
 | 
			
		||||
	case DSA_NOTIFIER_MRP_DEL_RING_ROLE:
 | 
			
		||||
		err = dsa_switch_mrp_del_ring_role(ds, info);
 | 
			
		||||
		break;
 | 
			
		||||
	default:
 | 
			
		||||
		err = -EOPNOTSUPP;
 | 
			
		||||
		break;
 | 
			
		||||
| 
						 | 
				
			
			
 | 
			
		|||
		Loading…
	
		Reference in a new issue