Loading...
1// SPDX-License-Identifier: GPL-2.0+
2
3#include <net/pkt_cls.h>
4#include <net/pkt_sched.h>
5
6#include "lan966x_main.h"
7
8static LIST_HEAD(lan966x_tc_block_cb_list);
9
10static int lan966x_tc_setup_qdisc_mqprio(struct lan966x_port *port,
11 struct tc_mqprio_qopt_offload *mqprio)
12{
13 u8 num_tc = mqprio->qopt.num_tc;
14
15 mqprio->qopt.hw = TC_MQPRIO_HW_OFFLOAD_TCS;
16
17 return num_tc ? lan966x_mqprio_add(port, num_tc) :
18 lan966x_mqprio_del(port);
19}
20
21static int lan966x_tc_setup_qdisc_taprio(struct lan966x_port *port,
22 struct tc_taprio_qopt_offload *taprio)
23{
24 switch (taprio->cmd) {
25 case TAPRIO_CMD_REPLACE:
26 return lan966x_taprio_add(port, taprio);
27 case TAPRIO_CMD_DESTROY:
28 return lan966x_taprio_del(port);
29 default:
30 return -EOPNOTSUPP;
31 }
32}
33
34static int lan966x_tc_setup_qdisc_tbf(struct lan966x_port *port,
35 struct tc_tbf_qopt_offload *qopt)
36{
37 switch (qopt->command) {
38 case TC_TBF_REPLACE:
39 return lan966x_tbf_add(port, qopt);
40 case TC_TBF_DESTROY:
41 return lan966x_tbf_del(port, qopt);
42 default:
43 return -EOPNOTSUPP;
44 }
45
46 return -EOPNOTSUPP;
47}
48
49static int lan966x_tc_setup_qdisc_cbs(struct lan966x_port *port,
50 struct tc_cbs_qopt_offload *qopt)
51{
52 return qopt->enable ? lan966x_cbs_add(port, qopt) :
53 lan966x_cbs_del(port, qopt);
54}
55
56static int lan966x_tc_setup_qdisc_ets(struct lan966x_port *port,
57 struct tc_ets_qopt_offload *qopt)
58{
59 switch (qopt->command) {
60 case TC_ETS_REPLACE:
61 return lan966x_ets_add(port, qopt);
62 case TC_ETS_DESTROY:
63 return lan966x_ets_del(port, qopt);
64 default:
65 return -EOPNOTSUPP;
66 };
67
68 return -EOPNOTSUPP;
69}
70
71static int lan966x_tc_block_cb(enum tc_setup_type type, void *type_data,
72 void *cb_priv, bool ingress)
73{
74 struct lan966x_port *port = cb_priv;
75
76 switch (type) {
77 case TC_SETUP_CLSMATCHALL:
78 return lan966x_tc_matchall(port, type_data, ingress);
79 case TC_SETUP_CLSFLOWER:
80 return lan966x_tc_flower(port, type_data, ingress);
81 default:
82 return -EOPNOTSUPP;
83 }
84}
85
86static int lan966x_tc_block_cb_ingress(enum tc_setup_type type,
87 void *type_data, void *cb_priv)
88{
89 return lan966x_tc_block_cb(type, type_data, cb_priv, true);
90}
91
92static int lan966x_tc_block_cb_egress(enum tc_setup_type type,
93 void *type_data, void *cb_priv)
94{
95 return lan966x_tc_block_cb(type, type_data, cb_priv, false);
96}
97
98static int lan966x_tc_setup_block(struct lan966x_port *port,
99 struct flow_block_offload *f)
100{
101 flow_setup_cb_t *cb;
102 bool ingress;
103
104 if (f->binder_type == FLOW_BLOCK_BINDER_TYPE_CLSACT_INGRESS) {
105 cb = lan966x_tc_block_cb_ingress;
106 port->tc.ingress_shared_block = f->block_shared;
107 ingress = true;
108 } else if (f->binder_type == FLOW_BLOCK_BINDER_TYPE_CLSACT_EGRESS) {
109 cb = lan966x_tc_block_cb_egress;
110 ingress = false;
111 } else {
112 return -EOPNOTSUPP;
113 }
114
115 return flow_block_cb_setup_simple(f, &lan966x_tc_block_cb_list,
116 cb, port, port, ingress);
117}
118
119int lan966x_tc_setup(struct net_device *dev, enum tc_setup_type type,
120 void *type_data)
121{
122 struct lan966x_port *port = netdev_priv(dev);
123
124 switch (type) {
125 case TC_SETUP_QDISC_MQPRIO:
126 return lan966x_tc_setup_qdisc_mqprio(port, type_data);
127 case TC_SETUP_QDISC_TAPRIO:
128 return lan966x_tc_setup_qdisc_taprio(port, type_data);
129 case TC_SETUP_QDISC_TBF:
130 return lan966x_tc_setup_qdisc_tbf(port, type_data);
131 case TC_SETUP_QDISC_CBS:
132 return lan966x_tc_setup_qdisc_cbs(port, type_data);
133 case TC_SETUP_QDISC_ETS:
134 return lan966x_tc_setup_qdisc_ets(port, type_data);
135 case TC_SETUP_BLOCK:
136 return lan966x_tc_setup_block(port, type_data);
137 default:
138 return -EOPNOTSUPP;
139 }
140
141 return 0;
142}
1// SPDX-License-Identifier: GPL-2.0+
2
3#include <net/pkt_cls.h>
4
5#include "lan966x_main.h"
6
7static LIST_HEAD(lan966x_tc_block_cb_list);
8
9static int lan966x_tc_setup_qdisc_mqprio(struct lan966x_port *port,
10 struct tc_mqprio_qopt_offload *mqprio)
11{
12 u8 num_tc = mqprio->qopt.num_tc;
13
14 mqprio->qopt.hw = TC_MQPRIO_HW_OFFLOAD_TCS;
15
16 return num_tc ? lan966x_mqprio_add(port, num_tc) :
17 lan966x_mqprio_del(port);
18}
19
20static int lan966x_tc_setup_qdisc_taprio(struct lan966x_port *port,
21 struct tc_taprio_qopt_offload *taprio)
22{
23 return taprio->enable ? lan966x_taprio_add(port, taprio) :
24 lan966x_taprio_del(port);
25}
26
27static int lan966x_tc_setup_qdisc_tbf(struct lan966x_port *port,
28 struct tc_tbf_qopt_offload *qopt)
29{
30 switch (qopt->command) {
31 case TC_TBF_REPLACE:
32 return lan966x_tbf_add(port, qopt);
33 case TC_TBF_DESTROY:
34 return lan966x_tbf_del(port, qopt);
35 default:
36 return -EOPNOTSUPP;
37 }
38
39 return -EOPNOTSUPP;
40}
41
42static int lan966x_tc_setup_qdisc_cbs(struct lan966x_port *port,
43 struct tc_cbs_qopt_offload *qopt)
44{
45 return qopt->enable ? lan966x_cbs_add(port, qopt) :
46 lan966x_cbs_del(port, qopt);
47}
48
49static int lan966x_tc_setup_qdisc_ets(struct lan966x_port *port,
50 struct tc_ets_qopt_offload *qopt)
51{
52 switch (qopt->command) {
53 case TC_ETS_REPLACE:
54 return lan966x_ets_add(port, qopt);
55 case TC_ETS_DESTROY:
56 return lan966x_ets_del(port, qopt);
57 default:
58 return -EOPNOTSUPP;
59 };
60
61 return -EOPNOTSUPP;
62}
63
64static int lan966x_tc_block_cb(enum tc_setup_type type, void *type_data,
65 void *cb_priv, bool ingress)
66{
67 struct lan966x_port *port = cb_priv;
68
69 switch (type) {
70 case TC_SETUP_CLSMATCHALL:
71 return lan966x_tc_matchall(port, type_data, ingress);
72 case TC_SETUP_CLSFLOWER:
73 return lan966x_tc_flower(port, type_data);
74 default:
75 return -EOPNOTSUPP;
76 }
77}
78
79static int lan966x_tc_block_cb_ingress(enum tc_setup_type type,
80 void *type_data, void *cb_priv)
81{
82 return lan966x_tc_block_cb(type, type_data, cb_priv, true);
83}
84
85static int lan966x_tc_block_cb_egress(enum tc_setup_type type,
86 void *type_data, void *cb_priv)
87{
88 return lan966x_tc_block_cb(type, type_data, cb_priv, false);
89}
90
91static int lan966x_tc_setup_block(struct lan966x_port *port,
92 struct flow_block_offload *f)
93{
94 flow_setup_cb_t *cb;
95 bool ingress;
96
97 if (f->binder_type == FLOW_BLOCK_BINDER_TYPE_CLSACT_INGRESS) {
98 cb = lan966x_tc_block_cb_ingress;
99 port->tc.ingress_shared_block = f->block_shared;
100 ingress = true;
101 } else if (f->binder_type == FLOW_BLOCK_BINDER_TYPE_CLSACT_EGRESS) {
102 cb = lan966x_tc_block_cb_egress;
103 ingress = false;
104 } else {
105 return -EOPNOTSUPP;
106 }
107
108 return flow_block_cb_setup_simple(f, &lan966x_tc_block_cb_list,
109 cb, port, port, ingress);
110}
111
112int lan966x_tc_setup(struct net_device *dev, enum tc_setup_type type,
113 void *type_data)
114{
115 struct lan966x_port *port = netdev_priv(dev);
116
117 switch (type) {
118 case TC_SETUP_QDISC_MQPRIO:
119 return lan966x_tc_setup_qdisc_mqprio(port, type_data);
120 case TC_SETUP_QDISC_TAPRIO:
121 return lan966x_tc_setup_qdisc_taprio(port, type_data);
122 case TC_SETUP_QDISC_TBF:
123 return lan966x_tc_setup_qdisc_tbf(port, type_data);
124 case TC_SETUP_QDISC_CBS:
125 return lan966x_tc_setup_qdisc_cbs(port, type_data);
126 case TC_SETUP_QDISC_ETS:
127 return lan966x_tc_setup_qdisc_ets(port, type_data);
128 case TC_SETUP_BLOCK:
129 return lan966x_tc_setup_block(port, type_data);
130 default:
131 return -EOPNOTSUPP;
132 }
133
134 return 0;
135}