1 // SPDX-License-Identifier: GPL-2.0+ 2 /* Microchip Sparx5 Switch driver 3 * 4 * Copyright (c) 2022 Microchip Technology Inc. and its subsidiaries. 5 */ 6 7 #include <net/pkt_cls.h> 8 9 #include "sparx5_tc.h" 10 #include "sparx5_main.h" 11 #include "sparx5_qos.h" 12 13 static void sparx5_tc_get_layer_and_idx(u32 parent, u32 portno, u32 *layer, 14 u32 *idx) 15 { 16 if (parent == TC_H_ROOT) { 17 *layer = 2; 18 *idx = portno; 19 } else { 20 u32 queue = TC_H_MIN(parent) - 1; 21 *layer = 0; 22 *idx = SPX5_HSCH_L0_GET_IDX(portno, queue); 23 } 24 } 25 26 static int sparx5_tc_setup_qdisc_mqprio(struct net_device *ndev, 27 struct tc_mqprio_qopt_offload *m) 28 { 29 m->qopt.hw = TC_MQPRIO_HW_OFFLOAD_TCS; 30 31 if (m->qopt.num_tc == 0) 32 return sparx5_tc_mqprio_del(ndev); 33 else 34 return sparx5_tc_mqprio_add(ndev, m->qopt.num_tc); 35 } 36 37 static int sparx5_tc_setup_qdisc_tbf(struct net_device *ndev, 38 struct tc_tbf_qopt_offload *qopt) 39 { 40 struct sparx5_port *port = netdev_priv(ndev); 41 u32 layer, se_idx; 42 43 sparx5_tc_get_layer_and_idx(qopt->parent, port->portno, &layer, 44 &se_idx); 45 46 switch (qopt->command) { 47 case TC_TBF_REPLACE: 48 return sparx5_tc_tbf_add(port, &qopt->replace_params, layer, 49 se_idx); 50 case TC_TBF_DESTROY: 51 return sparx5_tc_tbf_del(port, layer, se_idx); 52 case TC_TBF_STATS: 53 return -EOPNOTSUPP; 54 default: 55 return -EOPNOTSUPP; 56 } 57 58 return -EOPNOTSUPP; 59 } 60 61 int sparx5_port_setup_tc(struct net_device *ndev, enum tc_setup_type type, 62 void *type_data) 63 { 64 switch (type) { 65 case TC_SETUP_QDISC_MQPRIO: 66 return sparx5_tc_setup_qdisc_mqprio(ndev, type_data); 67 case TC_SETUP_QDISC_TBF: 68 return sparx5_tc_setup_qdisc_tbf(ndev, type_data); 69 default: 70 return -EOPNOTSUPP; 71 } 72 73 return 0; 74 } 75