Quelle  lan966x_tc.c   Sprache: 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)
{
 switch (taprio->cmd) {
 case TAPRIO_CMD_REPLACE:
  return lan966x_taprio_add(port, taprio);
 case TAPRIO_CMD_DESTROY:
  return lan966x_taprio_del(port);
 default:
  return -EOPNOTSUPP;
 }
}

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;
}