LXR linux/drivers/net/ethernet/mscc/ocelot

   1// SPDX-License-Identifier: (GPL-2.0 OR MIT)
   2/* Microsemi Ocelot Switch driver
   3 *
   4 * Copyright (c) 2019 Microsemi Corporation
   5 */
   6
   7#include <soc/mscc/ocelot.h>
   8#include "ocelot_police.h"
   9
  10/* Types for ANA:POL[0-192]:POL_MODE_CFG.FRM_MODE */
  11#define POL_MODE_LINERATE   0 /* Incl IPG. Unit: 33 1/3 kbps, 4096 bytes */
  12#define POL_MODE_DATARATE   1 /* Excl IPG. Unit: 33 1/3 kbps, 4096 bytes  */
  13#define POL_MODE_FRMRATE_HI 2 /* Unit: 33 1/3 fps, 32.8 frames */
  14#define POL_MODE_FRMRATE_LO 3 /* Unit: 1/3 fps, 0.3 frames */
  15
  16/* Policer indexes */
  17#define POL_IX_PORT    0    /* 0-11    : Port policers */
  18#define POL_IX_QUEUE   32   /* 32-127  : Queue policers  */
  19
  20/* Default policer order */
  21#define POL_ORDER 0x1d3 /* Ocelot policer order: Serial (QoS -> Port -> VCAP) */
  22
  23int qos_policer_conf_set(struct ocelot *ocelot, int port, u32 pol_ix,
  24                         struct qos_policer_conf *conf)
  25{
  26        u32 cf = 0, cir_ena = 0, frm_mode = POL_MODE_LINERATE;
  27        u32 cir = 0, cbs = 0, pir = 0, pbs = 0;
  28        bool cir_discard = 0, pir_discard = 0;
  29        u32 pbs_max = 0, cbs_max = 0;
  30        u8 ipg = 20;
  31        u32 value;
  32
  33        pir = conf->pir;
  34        pbs = conf->pbs;
  35
  36        switch (conf->mode) {
  37        case MSCC_QOS_RATE_MODE_LINE:
  38        case MSCC_QOS_RATE_MODE_DATA:
  39                if (conf->mode == MSCC_QOS_RATE_MODE_LINE) {
  40                        frm_mode = POL_MODE_LINERATE;
  41                        ipg = min_t(u8, GENMASK(4, 0), conf->ipg);
  42                } else {
  43                        frm_mode = POL_MODE_DATARATE;
  44                }
  45                if (conf->dlb) {
  46                        cir_ena = 1;
  47                        cir = conf->cir;
  48                        cbs = conf->cbs;
  49                        if (cir == 0 && cbs == 0) {
  50                                /* Discard cir frames */
  51                                cir_discard = 1;
  52                        } else {
  53                                cir = DIV_ROUND_UP(cir, 100);
  54                                cir *= 3; /* 33 1/3 kbps */
  55                                cbs = DIV_ROUND_UP(cbs, 4096);
  56                                cbs = (cbs ? cbs : 1); /* No zero burst size */
  57                                cbs_max = 60; /* Limit burst size */
  58                                cf = conf->cf;
  59                                if (cf)
  60                                        pir += conf->cir;
  61                        }
  62                }
  63                if (pir == 0 && pbs == 0) {
  64                        /* Discard PIR frames */
  65                        pir_discard = 1;
  66                } else {
  67                        pir = DIV_ROUND_UP(pir, 100);
  68                        pir *= 3;  /* 33 1/3 kbps */
  69                        pbs = DIV_ROUND_UP(pbs, 4096);
  70                        pbs = (pbs ? pbs : 1); /* No zero burst size */
  71                        pbs_max = 60; /* Limit burst size */
  72                }
  73                break;
  74        case MSCC_QOS_RATE_MODE_FRAME:
  75                if (pir >= 100) {
  76                        frm_mode = POL_MODE_FRMRATE_HI;
  77                        pir = DIV_ROUND_UP(pir, 100);
  78                        pir *= 3;  /* 33 1/3 fps */
  79                        pbs = (pbs * 10) / 328; /* 32.8 frames */
  80                        pbs = (pbs ? pbs : 1); /* No zero burst size */
  81                        pbs_max = GENMASK(6, 0); /* Limit burst size */
  82                } else {
  83                        frm_mode = POL_MODE_FRMRATE_LO;
  84                        if (pir == 0 && pbs == 0) {
  85                                /* Discard all frames */
  86                                pir_discard = 1;
  87                                cir_discard = 1;
  88                        } else {
  89                                pir *= 3; /* 1/3 fps */
  90                                pbs = (pbs * 10) / 3; /* 0.3 frames */
  91                                pbs = (pbs ? pbs : 1); /* No zero burst size */
  92                                pbs_max = 61; /* Limit burst size */
  93                        }
  94                }
  95                break;
  96        default: /* MSCC_QOS_RATE_MODE_DISABLED */
  97                /* Disable policer using maximum rate and zero burst */
  98                pir = GENMASK(15, 0);
  99                pbs = 0;
 100                break;
 101        }
 102
 103        /* Check limits */
 104        if (pir > GENMASK(15, 0)) {
 105                dev_err(ocelot->dev, "Invalid pir for port %d: %u (max %lu)\n",
 106                        port, pir, GENMASK(15, 0));
 107                return -EINVAL;
 108        }
 109
 110        if (cir > GENMASK(15, 0)) {
 111                dev_err(ocelot->dev, "Invalid cir for port %d: %u (max %lu)\n",
 112                        port, cir, GENMASK(15, 0));
 113                return -EINVAL;
 114        }
 115
 116        if (pbs > pbs_max) {
 117                dev_err(ocelot->dev, "Invalid pbs for port %d: %u (max %u)\n",
 118                        port, pbs, pbs_max);
 119                return -EINVAL;
 120        }
 121
 122        if (cbs > cbs_max) {
 123                dev_err(ocelot->dev, "Invalid cbs for port %d: %u (max %u)\n",
 124                        port, cbs, cbs_max);
 125                return -EINVAL;
 126        }
 127
 128        value = (ANA_POL_MODE_CFG_IPG_SIZE(ipg) |
 129                 ANA_POL_MODE_CFG_FRM_MODE(frm_mode) |
 130                 (cf ? ANA_POL_MODE_CFG_DLB_COUPLED : 0) |
 131                 (cir_ena ? ANA_POL_MODE_CFG_CIR_ENA : 0) |
 132                 ANA_POL_MODE_CFG_OVERSHOOT_ENA);
 133
 134        ocelot_write_gix(ocelot, value, ANA_POL_MODE_CFG, pol_ix);
 135
 136        ocelot_write_gix(ocelot,
 137                         ANA_POL_PIR_CFG_PIR_RATE(pir) |
 138                         ANA_POL_PIR_CFG_PIR_BURST(pbs),
 139                         ANA_POL_PIR_CFG, pol_ix);
 140
 141        ocelot_write_gix(ocelot,
 142                         (pir_discard ? GENMASK(22, 0) : 0),
 143                         ANA_POL_PIR_STATE, pol_ix);
 144
 145        ocelot_write_gix(ocelot,
 146                         ANA_POL_CIR_CFG_CIR_RATE(cir) |
 147                         ANA_POL_CIR_CFG_CIR_BURST(cbs),
 148                         ANA_POL_CIR_CFG, pol_ix);
 149
 150        ocelot_write_gix(ocelot,
 151                         (cir_discard ? GENMASK(22, 0) : 0),
 152                         ANA_POL_CIR_STATE, pol_ix);
 153
 154        return 0;
 155}
 156
 157int ocelot_port_policer_add(struct ocelot *ocelot, int port,
 158                            struct ocelot_policer *pol)
 159{
 160        struct qos_policer_conf pp = { 0 };
 161        int err;
 162
 163        if (!pol)
 164                return -EINVAL;
 165
 166        pp.mode = MSCC_QOS_RATE_MODE_DATA;
 167        pp.pir = pol->rate;
 168        pp.pbs = pol->burst;
 169
 170        dev_dbg(ocelot->dev, "%s: port %u pir %u kbps, pbs %u bytes\n",
 171                __func__, port, pp.pir, pp.pbs);
 172
 173        err = qos_policer_conf_set(ocelot, port, POL_IX_PORT + port, &pp);
 174        if (err)
 175                return err;
 176
 177        ocelot_rmw_gix(ocelot,
 178                       ANA_PORT_POL_CFG_PORT_POL_ENA |
 179                       ANA_PORT_POL_CFG_POL_ORDER(POL_ORDER),
 180                       ANA_PORT_POL_CFG_PORT_POL_ENA |
 181                       ANA_PORT_POL_CFG_POL_ORDER_M,
 182                       ANA_PORT_POL_CFG, port);
 183
 184        return 0;
 185}
 186EXPORT_SYMBOL(ocelot_port_policer_add);
 187
 188int ocelot_port_policer_del(struct ocelot *ocelot, int port)
 189{
 190        struct qos_policer_conf pp = { 0 };
 191        int err;
 192
 193        dev_dbg(ocelot->dev, "%s: port %u\n", __func__, port);
 194
 195        pp.mode = MSCC_QOS_RATE_MODE_DISABLED;
 196
 197        err = qos_policer_conf_set(ocelot, port, POL_IX_PORT + port, &pp);
 198        if (err)
 199                return err;
 200
 201        ocelot_rmw_gix(ocelot,
 202                       ANA_PORT_POL_CFG_POL_ORDER(POL_ORDER),
 203                       ANA_PORT_POL_CFG_PORT_POL_ENA |
 204                       ANA_PORT_POL_CFG_POL_ORDER_M,
 205                       ANA_PORT_POL_CFG, port);
 206
 207        return 0;
 208}
 209EXPORT_SYMBOL(ocelot_port_policer_del);
 210