137 lines
3.4 KiB
C
137 lines
3.4 KiB
C
// SPDX-License-Identifier: GPL-2.0+
|
|
|
|
#include <net/pkt_cls.h>
|
|
#include <net/pkt_sched.h>
|
|
|
|
#include "lan966x_main.h"
|
|
|
|
static LIST_HEAD(lan966x_tc_block_cb_list);
|
|
|
|
static int lan966x_tc_setup_qdisc_mqprio(struct lan966x_port *port,
|
|
struct tc_mqprio_qopt_offload *mqprio)
|
|
{
|
|
u8 num_tc = mqprio->qopt.num_tc;
|
|
|
|
mqprio->qopt.hw = TC_MQPRIO_HW_OFFLOAD_TCS;
|
|
|
|
return num_tc ? lan966x_mqprio_add(port, num_tc) :
|
|
lan966x_mqprio_del(port);
|
|
}
|
|
|
|
static int lan966x_tc_setup_qdisc_taprio(struct lan966x_port *port,
|
|
struct tc_taprio_qopt_offload *taprio)
|
|
{
|
|
return taprio->enable ? lan966x_taprio_add(port, taprio) :
|
|
lan966x_taprio_del(port);
|
|
}
|
|
|
|
static int lan966x_tc_setup_qdisc_tbf(struct lan966x_port *port,
|
|
struct tc_tbf_qopt_offload *qopt)
|
|
{
|
|
switch (qopt->command) {
|
|
case TC_TBF_REPLACE:
|
|
return lan966x_tbf_add(port, qopt);
|
|
case TC_TBF_DESTROY:
|
|
return lan966x_tbf_del(port, qopt);
|
|
default:
|
|
return -EOPNOTSUPP;
|
|
}
|
|
|
|
return -EOPNOTSUPP;
|
|
}
|
|
|
|
static int lan966x_tc_setup_qdisc_cbs(struct lan966x_port *port,
|
|
struct tc_cbs_qopt_offload *qopt)
|
|
{
|
|
return qopt->enable ? lan966x_cbs_add(port, qopt) :
|
|
lan966x_cbs_del(port, qopt);
|
|
}
|
|
|
|
static int lan966x_tc_setup_qdisc_ets(struct lan966x_port *port,
|
|
struct tc_ets_qopt_offload *qopt)
|
|
{
|
|
switch (qopt->command) {
|
|
case TC_ETS_REPLACE:
|
|
return lan966x_ets_add(port, qopt);
|
|
case TC_ETS_DESTROY:
|
|
return lan966x_ets_del(port, qopt);
|
|
default:
|
|
return -EOPNOTSUPP;
|
|
};
|
|
|
|
return -EOPNOTSUPP;
|
|
}
|
|
|
|
static int lan966x_tc_block_cb(enum tc_setup_type type, void *type_data,
|
|
void *cb_priv, bool ingress)
|
|
{
|
|
struct lan966x_port *port = cb_priv;
|
|
|
|
switch (type) {
|
|
case TC_SETUP_CLSMATCHALL:
|
|
return lan966x_tc_matchall(port, type_data, ingress);
|
|
case TC_SETUP_CLSFLOWER:
|
|
return lan966x_tc_flower(port, type_data, ingress);
|
|
default:
|
|
return -EOPNOTSUPP;
|
|
}
|
|
}
|
|
|
|
static int lan966x_tc_block_cb_ingress(enum tc_setup_type type,
|
|
void *type_data, void *cb_priv)
|
|
{
|
|
return lan966x_tc_block_cb(type, type_data, cb_priv, true);
|
|
}
|
|
|
|
static int lan966x_tc_block_cb_egress(enum tc_setup_type type,
|
|
void *type_data, void *cb_priv)
|
|
{
|
|
return lan966x_tc_block_cb(type, type_data, cb_priv, false);
|
|
}
|
|
|
|
static int lan966x_tc_setup_block(struct lan966x_port *port,
|
|
struct flow_block_offload *f)
|
|
{
|
|
flow_setup_cb_t *cb;
|
|
bool ingress;
|
|
|
|
if (f->binder_type == FLOW_BLOCK_BINDER_TYPE_CLSACT_INGRESS) {
|
|
cb = lan966x_tc_block_cb_ingress;
|
|
port->tc.ingress_shared_block = f->block_shared;
|
|
ingress = true;
|
|
} else if (f->binder_type == FLOW_BLOCK_BINDER_TYPE_CLSACT_EGRESS) {
|
|
cb = lan966x_tc_block_cb_egress;
|
|
ingress = false;
|
|
} else {
|
|
return -EOPNOTSUPP;
|
|
}
|
|
|
|
return flow_block_cb_setup_simple(f, &lan966x_tc_block_cb_list,
|
|
cb, port, port, ingress);
|
|
}
|
|
|
|
int lan966x_tc_setup(struct net_device *dev, enum tc_setup_type type,
|
|
void *type_data)
|
|
{
|
|
struct lan966x_port *port = netdev_priv(dev);
|
|
|
|
switch (type) {
|
|
case TC_SETUP_QDISC_MQPRIO:
|
|
return lan966x_tc_setup_qdisc_mqprio(port, type_data);
|
|
case TC_SETUP_QDISC_TAPRIO:
|
|
return lan966x_tc_setup_qdisc_taprio(port, type_data);
|
|
case TC_SETUP_QDISC_TBF:
|
|
return lan966x_tc_setup_qdisc_tbf(port, type_data);
|
|
case TC_SETUP_QDISC_CBS:
|
|
return lan966x_tc_setup_qdisc_cbs(port, type_data);
|
|
case TC_SETUP_QDISC_ETS:
|
|
return lan966x_tc_setup_qdisc_ets(port, type_data);
|
|
case TC_SETUP_BLOCK:
|
|
return lan966x_tc_setup_block(port, type_data);
|
|
default:
|
|
return -EOPNOTSUPP;
|
|
}
|
|
|
|
return 0;
|
|
}
|