1 // SPDX-License-Identifier: GPL-2.0+
2 /* Microchip VCAP API
3  *
4  * Copyright (c) 2022 Microchip Technology Inc. and its subsidiaries.
5  */
6 
7 #include "sparx5_tc.h"
8 #include "vcap_api.h"
9 #include "vcap_api_client.h"
10 #include "sparx5_main_regs.h"
11 #include "sparx5_main.h"
12 #include "sparx5_vcap_impl.h"
13 
sparx5_tc_matchall_replace(struct net_device * ndev,struct tc_cls_matchall_offload * tmo,bool ingress)14 static int sparx5_tc_matchall_replace(struct net_device *ndev,
15 				      struct tc_cls_matchall_offload *tmo,
16 				      bool ingress)
17 {
18 	struct sparx5_port *port = netdev_priv(ndev);
19 	struct flow_action_entry *action;
20 	struct sparx5 *sparx5;
21 	int err;
22 
23 	if (!flow_offload_has_one_action(&tmo->rule->action)) {
24 		NL_SET_ERR_MSG_MOD(tmo->common.extack,
25 				   "Only one action per filter is supported");
26 		return -EOPNOTSUPP;
27 	}
28 	action = &tmo->rule->action.entries[0];
29 
30 	sparx5 = port->sparx5;
31 	switch (action->id) {
32 	case FLOW_ACTION_GOTO:
33 		err = vcap_enable_lookups(sparx5->vcap_ctrl, ndev,
34 					  tmo->common.chain_index,
35 					  action->chain_index, tmo->cookie,
36 					  true);
37 		if (err == -EFAULT) {
38 			NL_SET_ERR_MSG_MOD(tmo->common.extack,
39 					   "Unsupported goto chain");
40 			return -EOPNOTSUPP;
41 		}
42 		if (err == -EADDRINUSE) {
43 			NL_SET_ERR_MSG_MOD(tmo->common.extack,
44 					   "VCAP already enabled");
45 			return -EOPNOTSUPP;
46 		}
47 		if (err == -EADDRNOTAVAIL) {
48 			NL_SET_ERR_MSG_MOD(tmo->common.extack,
49 					   "Already matching this chain");
50 			return -EOPNOTSUPP;
51 		}
52 		if (err) {
53 			NL_SET_ERR_MSG_MOD(tmo->common.extack,
54 					   "Could not enable VCAP lookups");
55 			return err;
56 		}
57 		break;
58 	default:
59 		NL_SET_ERR_MSG_MOD(tmo->common.extack, "Unsupported action");
60 		return -EOPNOTSUPP;
61 	}
62 	return 0;
63 }
64 
sparx5_tc_matchall_destroy(struct net_device * ndev,struct tc_cls_matchall_offload * tmo,bool ingress)65 static int sparx5_tc_matchall_destroy(struct net_device *ndev,
66 				      struct tc_cls_matchall_offload *tmo,
67 				      bool ingress)
68 {
69 	struct sparx5_port *port = netdev_priv(ndev);
70 	struct sparx5 *sparx5;
71 	int err;
72 
73 	sparx5 = port->sparx5;
74 	if (!tmo->rule && tmo->cookie) {
75 		err = vcap_enable_lookups(sparx5->vcap_ctrl, ndev,
76 					  0, 0, tmo->cookie, false);
77 		if (err)
78 			return err;
79 		return 0;
80 	}
81 	NL_SET_ERR_MSG_MOD(tmo->common.extack, "Unsupported action");
82 	return -EOPNOTSUPP;
83 }
84 
sparx5_tc_matchall(struct net_device * ndev,struct tc_cls_matchall_offload * tmo,bool ingress)85 int sparx5_tc_matchall(struct net_device *ndev,
86 		       struct tc_cls_matchall_offload *tmo,
87 		       bool ingress)
88 {
89 	switch (tmo->command) {
90 	case TC_CLSMATCHALL_REPLACE:
91 		return sparx5_tc_matchall_replace(ndev, tmo, ingress);
92 	case TC_CLSMATCHALL_DESTROY:
93 		return sparx5_tc_matchall_destroy(ndev, tmo, ingress);
94 	default:
95 		return -EOPNOTSUPP;
96 	}
97 }
98