xref: /openbmc/linux/drivers/net/ethernet/freescale/dpaa2/dpaa2-eth-devlink.c (revision 7ae9fb1b7ecbb5d85d07857943f677fd1a559b18)
1  // SPDX-License-Identifier: (GPL-2.0+ OR BSD-3-Clause)
2  #include "dpaa2-eth.h"
3  /* Copyright 2020 NXP
4   */
5  
6  #define DPAA2_ETH_TRAP_DROP(_id, _group_id)					\
7  	DEVLINK_TRAP_GENERIC(DROP, DROP, _id,					\
8  			     DEVLINK_TRAP_GROUP_GENERIC_ID_##_group_id, 0)
9  
10  static const struct devlink_trap_group dpaa2_eth_trap_groups_arr[] = {
11  	DEVLINK_TRAP_GROUP_GENERIC(PARSER_ERROR_DROPS, 0),
12  };
13  
14  static const struct devlink_trap dpaa2_eth_traps_arr[] = {
15  	DPAA2_ETH_TRAP_DROP(VXLAN_PARSING, PARSER_ERROR_DROPS),
16  	DPAA2_ETH_TRAP_DROP(LLC_SNAP_PARSING, PARSER_ERROR_DROPS),
17  	DPAA2_ETH_TRAP_DROP(VLAN_PARSING, PARSER_ERROR_DROPS),
18  	DPAA2_ETH_TRAP_DROP(PPPOE_PPP_PARSING, PARSER_ERROR_DROPS),
19  	DPAA2_ETH_TRAP_DROP(MPLS_PARSING, PARSER_ERROR_DROPS),
20  	DPAA2_ETH_TRAP_DROP(ARP_PARSING, PARSER_ERROR_DROPS),
21  	DPAA2_ETH_TRAP_DROP(IP_1_PARSING, PARSER_ERROR_DROPS),
22  	DPAA2_ETH_TRAP_DROP(IP_N_PARSING, PARSER_ERROR_DROPS),
23  	DPAA2_ETH_TRAP_DROP(GRE_PARSING, PARSER_ERROR_DROPS),
24  	DPAA2_ETH_TRAP_DROP(UDP_PARSING, PARSER_ERROR_DROPS),
25  	DPAA2_ETH_TRAP_DROP(TCP_PARSING, PARSER_ERROR_DROPS),
26  	DPAA2_ETH_TRAP_DROP(IPSEC_PARSING, PARSER_ERROR_DROPS),
27  	DPAA2_ETH_TRAP_DROP(SCTP_PARSING, PARSER_ERROR_DROPS),
28  	DPAA2_ETH_TRAP_DROP(DCCP_PARSING, PARSER_ERROR_DROPS),
29  	DPAA2_ETH_TRAP_DROP(GTP_PARSING, PARSER_ERROR_DROPS),
30  	DPAA2_ETH_TRAP_DROP(ESP_PARSING, PARSER_ERROR_DROPS),
31  };
32  
dpaa2_eth_dl_info_get(struct devlink * devlink,struct devlink_info_req * req,struct netlink_ext_ack * extack)33  static int dpaa2_eth_dl_info_get(struct devlink *devlink,
34  				 struct devlink_info_req *req,
35  				 struct netlink_ext_ack *extack)
36  {
37  	struct dpaa2_eth_devlink_priv *dl_priv = devlink_priv(devlink);
38  	struct dpaa2_eth_priv *priv = dl_priv->dpaa2_priv;
39  	char buf[10];
40  
41  	scnprintf(buf, 10, "%d.%d", priv->dpni_ver_major, priv->dpni_ver_minor);
42  	return devlink_info_version_running_put(req, "dpni", buf);
43  }
44  
45  static struct dpaa2_eth_trap_item *
dpaa2_eth_dl_trap_item_lookup(struct dpaa2_eth_priv * priv,u16 trap_id)46  dpaa2_eth_dl_trap_item_lookup(struct dpaa2_eth_priv *priv, u16 trap_id)
47  {
48  	struct dpaa2_eth_trap_data *dpaa2_eth_trap_data = priv->trap_data;
49  	int i;
50  
51  	for (i = 0; i < ARRAY_SIZE(dpaa2_eth_traps_arr); i++) {
52  		if (dpaa2_eth_traps_arr[i].id == trap_id)
53  			return &dpaa2_eth_trap_data->trap_items_arr[i];
54  	}
55  
56  	return NULL;
57  }
58  
dpaa2_eth_dl_get_trap(struct dpaa2_eth_priv * priv,struct dpaa2_fapr * fapr)59  struct dpaa2_eth_trap_item *dpaa2_eth_dl_get_trap(struct dpaa2_eth_priv *priv,
60  						  struct dpaa2_fapr *fapr)
61  {
62  	static const struct dpaa2_faf_error_bit {
63  		int position;
64  		enum devlink_trap_generic_id trap_id;
65  	} faf_bits[] = {
66  		{ .position = 5,  .trap_id = DEVLINK_TRAP_GENERIC_ID_VXLAN_PARSING },
67  		{ .position = 20, .trap_id = DEVLINK_TRAP_GENERIC_ID_LLC_SNAP_PARSING },
68  		{ .position = 24, .trap_id = DEVLINK_TRAP_GENERIC_ID_VLAN_PARSING },
69  		{ .position = 26, .trap_id = DEVLINK_TRAP_GENERIC_ID_PPPOE_PPP_PARSING },
70  		{ .position = 29, .trap_id = DEVLINK_TRAP_GENERIC_ID_MPLS_PARSING },
71  		{ .position = 31, .trap_id = DEVLINK_TRAP_GENERIC_ID_ARP_PARSING },
72  		{ .position = 52, .trap_id = DEVLINK_TRAP_GENERIC_ID_IP_1_PARSING },
73  		{ .position = 61, .trap_id = DEVLINK_TRAP_GENERIC_ID_IP_N_PARSING },
74  		{ .position = 67, .trap_id = DEVLINK_TRAP_GENERIC_ID_GRE_PARSING },
75  		{ .position = 71, .trap_id = DEVLINK_TRAP_GENERIC_ID_UDP_PARSING },
76  		{ .position = 76, .trap_id = DEVLINK_TRAP_GENERIC_ID_TCP_PARSING },
77  		{ .position = 80, .trap_id = DEVLINK_TRAP_GENERIC_ID_IPSEC_PARSING },
78  		{ .position = 82, .trap_id = DEVLINK_TRAP_GENERIC_ID_SCTP_PARSING },
79  		{ .position = 84, .trap_id = DEVLINK_TRAP_GENERIC_ID_DCCP_PARSING },
80  		{ .position = 88, .trap_id = DEVLINK_TRAP_GENERIC_ID_GTP_PARSING },
81  		{ .position = 90, .trap_id = DEVLINK_TRAP_GENERIC_ID_ESP_PARSING },
82  	};
83  	u64 faf_word;
84  	u64 mask;
85  	int i;
86  
87  	for (i = 0; i < ARRAY_SIZE(faf_bits); i++) {
88  		if (faf_bits[i].position < 32) {
89  			/* Low part of FAF.
90  			 * position ranges from 31 to 0, mask from 0 to 31.
91  			 */
92  			mask = 1ull << (31 - faf_bits[i].position);
93  			faf_word = __le32_to_cpu(fapr->faf_lo);
94  		} else {
95  			/* High part of FAF.
96  			 * position ranges from 95 to 32, mask from 0 to 63.
97  			 */
98  			mask = 1ull << (63 - (faf_bits[i].position - 32));
99  			faf_word = __le64_to_cpu(fapr->faf_hi);
100  		}
101  		if (faf_word & mask)
102  			return dpaa2_eth_dl_trap_item_lookup(priv, faf_bits[i].trap_id);
103  	}
104  	return NULL;
105  }
106  
dpaa2_eth_dl_trap_init(struct devlink * devlink,const struct devlink_trap * trap,void * trap_ctx)107  static int dpaa2_eth_dl_trap_init(struct devlink *devlink,
108  				  const struct devlink_trap *trap,
109  				  void *trap_ctx)
110  {
111  	struct dpaa2_eth_devlink_priv *dl_priv = devlink_priv(devlink);
112  	struct dpaa2_eth_priv *priv = dl_priv->dpaa2_priv;
113  	struct dpaa2_eth_trap_item *dpaa2_eth_trap_item;
114  
115  	dpaa2_eth_trap_item = dpaa2_eth_dl_trap_item_lookup(priv, trap->id);
116  	if (WARN_ON(!dpaa2_eth_trap_item))
117  		return -ENOENT;
118  
119  	dpaa2_eth_trap_item->trap_ctx = trap_ctx;
120  
121  	return 0;
122  }
123  
dpaa2_eth_dl_trap_action_set(struct devlink * devlink,const struct devlink_trap * trap,enum devlink_trap_action action,struct netlink_ext_ack * extack)124  static int dpaa2_eth_dl_trap_action_set(struct devlink *devlink,
125  					const struct devlink_trap *trap,
126  					enum devlink_trap_action action,
127  					struct netlink_ext_ack *extack)
128  {
129  	/* No support for changing the action of an independent packet trap,
130  	 * only per trap group - parser error drops
131  	 */
132  	NL_SET_ERR_MSG_MOD(extack,
133  			   "Cannot change trap action independently of group");
134  	return -EOPNOTSUPP;
135  }
136  
dpaa2_eth_dl_trap_group_action_set(struct devlink * devlink,const struct devlink_trap_group * group,enum devlink_trap_action action,struct netlink_ext_ack * extack)137  static int dpaa2_eth_dl_trap_group_action_set(struct devlink *devlink,
138  					      const struct devlink_trap_group *group,
139  					      enum devlink_trap_action action,
140  					      struct netlink_ext_ack *extack)
141  {
142  	struct dpaa2_eth_devlink_priv *dl_priv = devlink_priv(devlink);
143  	struct dpaa2_eth_priv *priv = dl_priv->dpaa2_priv;
144  	struct net_device *net_dev = priv->net_dev;
145  	struct device *dev = net_dev->dev.parent;
146  	struct dpni_error_cfg err_cfg = {0};
147  	int err;
148  
149  	if (group->id != DEVLINK_TRAP_GROUP_GENERIC_ID_PARSER_ERROR_DROPS)
150  		return -EOPNOTSUPP;
151  
152  	/* Configure handling of frames marked as errors from the parser */
153  	err_cfg.errors = DPAA2_FAS_RX_ERR_MASK;
154  	err_cfg.set_frame_annotation = 1;
155  
156  	switch (action) {
157  	case DEVLINK_TRAP_ACTION_DROP:
158  		err_cfg.error_action = DPNI_ERROR_ACTION_DISCARD;
159  		break;
160  	case DEVLINK_TRAP_ACTION_TRAP:
161  		err_cfg.error_action = DPNI_ERROR_ACTION_SEND_TO_ERROR_QUEUE;
162  		break;
163  	default:
164  		return -EOPNOTSUPP;
165  	}
166  
167  	err = dpni_set_errors_behavior(priv->mc_io, 0, priv->mc_token, &err_cfg);
168  	if (err) {
169  		dev_err(dev, "dpni_set_errors_behavior failed\n");
170  		return err;
171  	}
172  
173  	return 0;
174  }
175  
176  static const struct devlink_ops dpaa2_eth_devlink_ops = {
177  	.info_get = dpaa2_eth_dl_info_get,
178  	.trap_init = dpaa2_eth_dl_trap_init,
179  	.trap_action_set = dpaa2_eth_dl_trap_action_set,
180  	.trap_group_action_set = dpaa2_eth_dl_trap_group_action_set,
181  };
182  
dpaa2_eth_dl_alloc(struct dpaa2_eth_priv * priv)183  int dpaa2_eth_dl_alloc(struct dpaa2_eth_priv *priv)
184  {
185  	struct net_device *net_dev = priv->net_dev;
186  	struct device *dev = net_dev->dev.parent;
187  	struct dpaa2_eth_devlink_priv *dl_priv;
188  
189  	priv->devlink =
190  		devlink_alloc(&dpaa2_eth_devlink_ops, sizeof(*dl_priv), dev);
191  	if (!priv->devlink) {
192  		dev_err(dev, "devlink_alloc failed\n");
193  		return -ENOMEM;
194  	}
195  	dl_priv = devlink_priv(priv->devlink);
196  	dl_priv->dpaa2_priv = priv;
197  	return 0;
198  }
199  
dpaa2_eth_dl_free(struct dpaa2_eth_priv * priv)200  void dpaa2_eth_dl_free(struct dpaa2_eth_priv *priv)
201  {
202  	devlink_free(priv->devlink);
203  }
204  
205  
dpaa2_eth_dl_register(struct dpaa2_eth_priv * priv)206  void dpaa2_eth_dl_register(struct dpaa2_eth_priv *priv)
207  {
208  	devlink_register(priv->devlink);
209  }
210  
dpaa2_eth_dl_unregister(struct dpaa2_eth_priv * priv)211  void dpaa2_eth_dl_unregister(struct dpaa2_eth_priv *priv)
212  {
213  	devlink_unregister(priv->devlink);
214  }
215  
dpaa2_eth_dl_port_add(struct dpaa2_eth_priv * priv)216  int dpaa2_eth_dl_port_add(struct dpaa2_eth_priv *priv)
217  {
218  	struct devlink_port *devlink_port = &priv->devlink_port;
219  	struct devlink_port_attrs attrs = {};
220  
221  	attrs.flavour = DEVLINK_PORT_FLAVOUR_PHYSICAL;
222  	devlink_port_attrs_set(devlink_port, &attrs);
223  	return devlink_port_register(priv->devlink, devlink_port, 0);
224  }
225  
dpaa2_eth_dl_port_del(struct dpaa2_eth_priv * priv)226  void dpaa2_eth_dl_port_del(struct dpaa2_eth_priv *priv)
227  {
228  	struct devlink_port *devlink_port = &priv->devlink_port;
229  
230  	devlink_port_unregister(devlink_port);
231  }
232  
dpaa2_eth_dl_traps_register(struct dpaa2_eth_priv * priv)233  int dpaa2_eth_dl_traps_register(struct dpaa2_eth_priv *priv)
234  {
235  	struct dpaa2_eth_trap_data *dpaa2_eth_trap_data;
236  	struct net_device *net_dev = priv->net_dev;
237  	struct device *dev = net_dev->dev.parent;
238  	int err;
239  
240  	dpaa2_eth_trap_data = kzalloc(sizeof(*dpaa2_eth_trap_data), GFP_KERNEL);
241  	if (!dpaa2_eth_trap_data)
242  		return -ENOMEM;
243  	priv->trap_data = dpaa2_eth_trap_data;
244  
245  	dpaa2_eth_trap_data->trap_items_arr = kcalloc(ARRAY_SIZE(dpaa2_eth_traps_arr),
246  						      sizeof(struct dpaa2_eth_trap_item),
247  						      GFP_KERNEL);
248  	if (!dpaa2_eth_trap_data->trap_items_arr) {
249  		err = -ENOMEM;
250  		goto trap_data_free;
251  	}
252  
253  	err = devlink_trap_groups_register(priv->devlink, dpaa2_eth_trap_groups_arr,
254  					   ARRAY_SIZE(dpaa2_eth_trap_groups_arr));
255  	if (err) {
256  		dev_err(dev, "devlink_trap_groups_register() = %d\n", err);
257  		goto trap_items_arr_free;
258  	}
259  
260  	err = devlink_traps_register(priv->devlink, dpaa2_eth_traps_arr,
261  				     ARRAY_SIZE(dpaa2_eth_traps_arr), priv);
262  	if (err) {
263  		dev_err(dev, "devlink_traps_register() = %d\n", err);
264  		goto trap_groups_unregiser;
265  	}
266  
267  	return 0;
268  
269  trap_groups_unregiser:
270  	devlink_trap_groups_unregister(priv->devlink, dpaa2_eth_trap_groups_arr,
271  				       ARRAY_SIZE(dpaa2_eth_trap_groups_arr));
272  trap_items_arr_free:
273  	kfree(dpaa2_eth_trap_data->trap_items_arr);
274  trap_data_free:
275  	kfree(dpaa2_eth_trap_data);
276  	priv->trap_data = NULL;
277  
278  	return err;
279  }
280  
dpaa2_eth_dl_traps_unregister(struct dpaa2_eth_priv * priv)281  void dpaa2_eth_dl_traps_unregister(struct dpaa2_eth_priv *priv)
282  {
283  	devlink_traps_unregister(priv->devlink, dpaa2_eth_traps_arr,
284  				 ARRAY_SIZE(dpaa2_eth_traps_arr));
285  	devlink_trap_groups_unregister(priv->devlink, dpaa2_eth_trap_groups_arr,
286  				       ARRAY_SIZE(dpaa2_eth_trap_groups_arr));
287  	kfree(priv->trap_data->trap_items_arr);
288  	kfree(priv->trap_data);
289  }
290