net/octeontx2: restructure TM helper functions
authorNithin Dabilpuram <ndabilpuram@marvell.com>
Fri, 3 Apr 2020 08:52:07 +0000 (14:22 +0530)
committerFerruh Yigit <ferruh.yigit@intel.com>
Tue, 21 Apr 2020 11:57:06 +0000 (13:57 +0200)
Restructure traffic manager helper function by splitting to
multiple sets of register configurations like shaping, scheduling
and topology config.

Signed-off-by: Nithin Dabilpuram <ndabilpuram@marvell.com>
Signed-off-by: Krzysztof Kanas <kkanas@marvell.com>
drivers/net/octeontx2/otx2_tm.c
drivers/net/octeontx2/otx2_tm.h

index 2364e03..108f44c 100644 (file)
@@ -94,52 +94,50 @@ nix_tm_shaper_profile_search(struct otx2_eth_dev *dev, uint32_t shaper_id)
 }
 
 static inline uint64_t
-shaper_rate_to_nix(uint64_t cclk_hz, uint64_t cclk_ticks,
-                  uint64_t value, uint64_t *exponent_p,
+shaper_rate_to_nix(uint64_t value, uint64_t *exponent_p,
                   uint64_t *mantissa_p, uint64_t *div_exp_p)
 {
        uint64_t div_exp, exponent, mantissa;
 
        /* Boundary checks */
-       if (value < MIN_SHAPER_RATE(cclk_hz, cclk_ticks) ||
-           value > MAX_SHAPER_RATE(cclk_hz, cclk_ticks))
+       if (value < MIN_SHAPER_RATE ||
+           value > MAX_SHAPER_RATE)
                return 0;
 
-       if (value <= SHAPER_RATE(cclk_hz, cclk_ticks, 0, 0, 0)) {
+       if (value <= SHAPER_RATE(0, 0, 0)) {
                /* Calculate rate div_exp and mantissa using
                 * the following formula:
                 *
-                * value = (cclk_hz * (256 + mantissa)
-                *              / ((cclk_ticks << div_exp) * 256)
+                * value = (2E6 * (256 + mantissa)
+                *              / ((1 << div_exp) * 256))
                 */
                div_exp = 0;
                exponent = 0;
                mantissa = MAX_RATE_MANTISSA;
 
-               while (value < (cclk_hz / (cclk_ticks << div_exp)))
+               while (value < (NIX_SHAPER_RATE_CONST / (1 << div_exp)))
                        div_exp += 1;
 
                while (value <
-                      ((cclk_hz * (256 + mantissa)) /
-                       ((cclk_ticks << div_exp) * 256)))
+                      ((NIX_SHAPER_RATE_CONST * (256 + mantissa)) /
+                       ((1 << div_exp) * 256)))
                        mantissa -= 1;
        } else {
                /* Calculate rate exponent and mantissa using
                 * the following formula:
                 *
-                * value = (cclk_hz * ((256 + mantissa) << exponent)
-                *              / (cclk_ticks * 256)
+                * value = (2E6 * ((256 + mantissa) << exponent)) / 256
                 *
                 */
                div_exp = 0;
                exponent = MAX_RATE_EXPONENT;
                mantissa = MAX_RATE_MANTISSA;
 
-               while (value < (cclk_hz * (1 << exponent)) / cclk_ticks)
+               while (value < (NIX_SHAPER_RATE_CONST * (1 << exponent)))
                        exponent -= 1;
 
-               while (value < (cclk_hz * ((256 + mantissa) << exponent)) /
-                      (cclk_ticks * 256))
+               while (value < ((NIX_SHAPER_RATE_CONST *
+                               ((256 + mantissa) << exponent)) / 256))
                        mantissa -= 1;
        }
 
@@ -155,20 +153,7 @@ shaper_rate_to_nix(uint64_t cclk_hz, uint64_t cclk_ticks,
                *mantissa_p = mantissa;
 
        /* Calculate real rate value */
-       return SHAPER_RATE(cclk_hz, cclk_ticks, exponent, mantissa, div_exp);
-}
-
-static inline uint64_t
-lx_shaper_rate_to_nix(uint64_t cclk_hz, uint32_t hw_lvl,
-                     uint64_t value, uint64_t *exponent,
-                     uint64_t *mantissa, uint64_t *div_exp)
-{
-       if (hw_lvl == NIX_TXSCH_LVL_TL1)
-               return shaper_rate_to_nix(cclk_hz, L1_TIME_WHEEL_CCLK_TICKS,
-                                         value, exponent, mantissa, div_exp);
-       else
-               return shaper_rate_to_nix(cclk_hz, LX_TIME_WHEEL_CCLK_TICKS,
-                                         value, exponent, mantissa, div_exp);
+       return SHAPER_RATE(exponent, mantissa, div_exp);
 }
 
 static inline uint64_t
@@ -207,329 +192,394 @@ shaper_burst_to_nix(uint64_t value, uint64_t *exponent_p,
        return SHAPER_BURST(exponent, mantissa);
 }
 
+static void
+shaper_config_to_nix(struct otx2_nix_tm_shaper_profile *profile,
+                    struct shaper_params *cir,
+                    struct shaper_params *pir)
+{
+       struct rte_tm_shaper_params *param = &profile->params;
+
+       if (!profile)
+               return;
+
+       /* Calculate CIR exponent and mantissa */
+       if (param->committed.rate)
+               cir->rate = shaper_rate_to_nix(param->committed.rate,
+                                              &cir->exponent,
+                                              &cir->mantissa,
+                                              &cir->div_exp);
+
+       /* Calculate PIR exponent and mantissa */
+       if (param->peak.rate)
+               pir->rate = shaper_rate_to_nix(param->peak.rate,
+                                              &pir->exponent,
+                                              &pir->mantissa,
+                                              &pir->div_exp);
+
+       /* Calculate CIR burst exponent and mantissa */
+       if (param->committed.size)
+               cir->burst = shaper_burst_to_nix(param->committed.size,
+                                                &cir->burst_exponent,
+                                                &cir->burst_mantissa);
+
+       /* Calculate PIR burst exponent and mantissa */
+       if (param->peak.size)
+               pir->burst = shaper_burst_to_nix(param->peak.size,
+                                                &pir->burst_exponent,
+                                                &pir->burst_mantissa);
+}
+
 static int
-configure_shaper_cir_pir_reg(struct otx2_eth_dev *dev,
-                            struct otx2_nix_tm_node *tm_node,
-                            struct shaper_params *cir,
-                            struct shaper_params *pir)
+populate_tm_tl1_default(struct otx2_eth_dev *dev, uint32_t schq)
 {
-       uint32_t shaper_profile_id = RTE_TM_SHAPER_PROFILE_ID_NONE;
-       struct otx2_nix_tm_shaper_profile *shaper_profile = NULL;
-       struct rte_tm_shaper_params *param;
+       struct otx2_mbox *mbox = dev->mbox;
+       struct nix_txschq_config *req;
 
-       shaper_profile_id = tm_node->params.shaper_profile_id;
+       /*
+        * Default config for TL1.
+        * For VF this is always ignored.
+        */
 
-       shaper_profile = nix_tm_shaper_profile_search(dev, shaper_profile_id);
-       if (shaper_profile) {
-               param = &shaper_profile->profile;
-               /* Calculate CIR exponent and mantissa */
-               if (param->committed.rate)
-                       cir->rate = lx_shaper_rate_to_nix(CCLK_HZ,
-                                                         tm_node->hw_lvl_id,
-                                                         param->committed.rate,
-                                                         &cir->exponent,
-                                                         &cir->mantissa,
-                                                         &cir->div_exp);
-
-               /* Calculate PIR exponent and mantissa */
-               if (param->peak.rate)
-                       pir->rate = lx_shaper_rate_to_nix(CCLK_HZ,
-                                                         tm_node->hw_lvl_id,
-                                                         param->peak.rate,
-                                                         &pir->exponent,
-                                                         &pir->mantissa,
-                                                         &pir->div_exp);
-
-               /* Calculate CIR burst exponent and mantissa */
-               if (param->committed.size)
-                       cir->burst = shaper_burst_to_nix(param->committed.size,
-                                                        &cir->burst_exponent,
-                                                        &cir->burst_mantissa);
-
-               /* Calculate PIR burst exponent and mantissa */
-               if (param->peak.size)
-                       pir->burst = shaper_burst_to_nix(param->peak.size,
-                                                        &pir->burst_exponent,
-                                                        &pir->burst_mantissa);
+       req = otx2_mbox_alloc_msg_nix_txschq_cfg(mbox);
+       req->lvl = NIX_TXSCH_LVL_TL1;
+
+       /* Set DWRR quantum */
+       req->reg[0] = NIX_AF_TL1X_SCHEDULE(schq);
+       req->regval[0] = TXSCH_TL1_DFLT_RR_QTM;
+       req->num_regs++;
+
+       req->reg[1] = NIX_AF_TL1X_TOPOLOGY(schq);
+       req->regval[1] = (TXSCH_TL1_DFLT_RR_PRIO << 1);
+       req->num_regs++;
+
+       req->reg[2] = NIX_AF_TL1X_CIR(schq);
+       req->regval[2] = 0;
+       req->num_regs++;
+
+       return otx2_mbox_process(mbox);
+}
+
+static uint8_t
+prepare_tm_sched_reg(struct otx2_eth_dev *dev,
+                    struct otx2_nix_tm_node *tm_node,
+                    volatile uint64_t *reg, volatile uint64_t *regval)
+{
+       uint64_t strict_prio = tm_node->priority;
+       uint32_t hw_lvl = tm_node->hw_lvl;
+       uint32_t schq = tm_node->hw_id;
+       uint64_t rr_quantum;
+       uint8_t k = 0;
+
+       rr_quantum = NIX_TM_WEIGHT_TO_RR_QUANTUM(tm_node->weight);
+
+       /* For children to root, strict prio is default if either
+        * device root is TL2 or TL1 Static Priority is disabled.
+        */
+       if (hw_lvl == NIX_TXSCH_LVL_TL2 &&
+           (dev->otx2_tm_root_lvl == NIX_TXSCH_LVL_TL2 ||
+            dev->tm_flags & NIX_TM_TL1_NO_SP))
+               strict_prio = TXSCH_TL1_DFLT_RR_PRIO;
+
+       otx2_tm_dbg("Schedule config node %s(%u) lvl %u id %u, "
+                    "prio 0x%" PRIx64 ", rr_quantum 0x%" PRIx64 " (%p)",
+                    nix_hwlvl2str(tm_node->hw_lvl), schq, tm_node->lvl,
+                    tm_node->id, strict_prio, rr_quantum, tm_node);
+
+       switch (hw_lvl) {
+       case NIX_TXSCH_LVL_SMQ:
+               reg[k] = NIX_AF_MDQX_SCHEDULE(schq);
+               regval[k] = (strict_prio << 24) | rr_quantum;
+               k++;
+
+               break;
+       case NIX_TXSCH_LVL_TL4:
+               reg[k] = NIX_AF_TL4X_SCHEDULE(schq);
+               regval[k] = (strict_prio << 24) | rr_quantum;
+               k++;
+
+               break;
+       case NIX_TXSCH_LVL_TL3:
+               reg[k] = NIX_AF_TL3X_SCHEDULE(schq);
+               regval[k] = (strict_prio << 24) | rr_quantum;
+               k++;
+
+               break;
+       case NIX_TXSCH_LVL_TL2:
+               reg[k] = NIX_AF_TL2X_SCHEDULE(schq);
+               regval[k] = (strict_prio << 24) | rr_quantum;
+               k++;
+
+               break;
+       case NIX_TXSCH_LVL_TL1:
+               reg[k] = NIX_AF_TL1X_SCHEDULE(schq);
+               regval[k] = rr_quantum;
+               k++;
+
+               break;
        }
 
-       return 0;
+       return k;
 }
 
-static int
-send_tm_reqval(struct otx2_mbox *mbox, struct nix_txschq_config *req)
+static uint8_t
+prepare_tm_shaper_reg(struct otx2_nix_tm_node *tm_node,
+                     struct otx2_nix_tm_shaper_profile *profile,
+                     volatile uint64_t *reg, volatile uint64_t *regval)
 {
-       int rc;
+       struct shaper_params cir, pir;
+       uint32_t schq = tm_node->hw_id;
+       uint8_t k = 0;
 
-       if (req->num_regs > MAX_REGS_PER_MBOX_MSG)
-               return -ERANGE;
+       memset(&cir, 0, sizeof(cir));
+       memset(&pir, 0, sizeof(pir));
+       shaper_config_to_nix(profile, &cir, &pir);
 
-       rc = otx2_mbox_process(mbox);
-       if (rc)
-               return rc;
+       otx2_tm_dbg("Shaper config node %s(%u) lvl %u id %u, "
+                   "pir %" PRIu64 "(%" PRIu64 "B),"
+                    " cir %" PRIu64 "(%" PRIu64 "B) (%p)",
+                    nix_hwlvl2str(tm_node->hw_lvl), schq, tm_node->lvl,
+                    tm_node->id, pir.rate, pir.burst,
+                    cir.rate, cir.burst, tm_node);
 
-       req->num_regs = 0;
-       return 0;
+       switch (tm_node->hw_lvl) {
+       case NIX_TXSCH_LVL_SMQ:
+               /* Configure PIR, CIR */
+               reg[k] = NIX_AF_MDQX_PIR(schq);
+               regval[k] = (pir.rate && pir.burst) ?
+                               (shaper2regval(&pir) | 1) : 0;
+               k++;
+
+               reg[k] = NIX_AF_MDQX_CIR(schq);
+               regval[k] = (cir.rate && cir.burst) ?
+                               (shaper2regval(&cir) | 1) : 0;
+               k++;
+
+               /* Configure RED ALG */
+               reg[k] = NIX_AF_MDQX_SHAPE(schq);
+               regval[k] = ((uint64_t)tm_node->red_algo << 9);
+               k++;
+               break;
+       case NIX_TXSCH_LVL_TL4:
+               /* Configure PIR, CIR */
+               reg[k] = NIX_AF_TL4X_PIR(schq);
+               regval[k] = (pir.rate && pir.burst) ?
+                               (shaper2regval(&pir) | 1) : 0;
+               k++;
+
+               reg[k] = NIX_AF_TL4X_CIR(schq);
+               regval[k] = (cir.rate && cir.burst) ?
+                               (shaper2regval(&cir) | 1) : 0;
+               k++;
+
+               /* Configure RED algo */
+               reg[k] = NIX_AF_TL4X_SHAPE(schq);
+               regval[k] = ((uint64_t)tm_node->red_algo << 9);
+               k++;
+               break;
+       case NIX_TXSCH_LVL_TL3:
+               /* Configure PIR, CIR */
+               reg[k] = NIX_AF_TL3X_PIR(schq);
+               regval[k] = (pir.rate && pir.burst) ?
+                               (shaper2regval(&pir) | 1) : 0;
+               k++;
+
+               reg[k] = NIX_AF_TL3X_CIR(schq);
+               regval[k] = (cir.rate && cir.burst) ?
+                               (shaper2regval(&cir) | 1) : 0;
+               k++;
+
+               /* Configure RED algo */
+               reg[k] = NIX_AF_TL3X_SHAPE(schq);
+               regval[k] = ((uint64_t)tm_node->red_algo << 9);
+               k++;
+
+               break;
+       case NIX_TXSCH_LVL_TL2:
+               /* Configure PIR, CIR */
+               reg[k] = NIX_AF_TL2X_PIR(schq);
+               regval[k] = (pir.rate && pir.burst) ?
+                               (shaper2regval(&pir) | 1) : 0;
+               k++;
+
+               reg[k] = NIX_AF_TL2X_CIR(schq);
+               regval[k] = (cir.rate && cir.burst) ?
+                               (shaper2regval(&cir) | 1) : 0;
+               k++;
+
+               /* Configure RED algo */
+               reg[k] = NIX_AF_TL2X_SHAPE(schq);
+               regval[k] = ((uint64_t)tm_node->red_algo << 9);
+               k++;
+
+               break;
+       case NIX_TXSCH_LVL_TL1:
+               /* Configure CIR */
+               reg[k] = NIX_AF_TL1X_CIR(schq);
+               regval[k] = (cir.rate && cir.burst) ?
+                               (shaper2regval(&cir) | 1) : 0;
+               k++;
+               break;
+       }
+
+       return k;
 }
 
 static int
-populate_tm_registers(struct otx2_eth_dev *dev,
-                     struct otx2_nix_tm_node *tm_node)
+populate_tm_reg(struct otx2_eth_dev *dev,
+               struct otx2_nix_tm_node *tm_node)
 {
-       uint64_t strict_schedul_prio, rr_prio;
+       struct otx2_nix_tm_shaper_profile *profile;
+       uint64_t regval_mask[MAX_REGS_PER_MBOX_MSG];
+       uint64_t regval[MAX_REGS_PER_MBOX_MSG];
+       uint64_t reg[MAX_REGS_PER_MBOX_MSG];
        struct otx2_mbox *mbox = dev->mbox;
-       volatile uint64_t *reg, *regval;
        uint64_t parent = 0, child = 0;
-       struct shaper_params cir, pir;
+       uint32_t hw_lvl, rr_prio, schq;
        struct nix_txschq_config *req;
-       uint64_t rr_quantum;
-       uint32_t hw_lvl;
-       uint32_t schq;
-       int rc;
+       int rc = -EFAULT;
+       uint8_t k = 0;
 
-       memset(&cir, 0, sizeof(cir));
-       memset(&pir, 0, sizeof(pir));
-
-       /* Skip leaf nodes */
-       if (tm_node->hw_lvl_id == NIX_TXSCH_LVL_CNT)
-               return 0;
+       memset(regval_mask, 0, sizeof(regval_mask));
+       profile = nix_tm_shaper_profile_search(dev,
+                                       tm_node->params.shaper_profile_id);
+       rr_prio = tm_node->rr_prio;
+       hw_lvl = tm_node->hw_lvl;
+       schq = tm_node->hw_id;
 
        /* Root node will not have a parent node */
-       if (tm_node->hw_lvl_id == dev->otx2_tm_root_lvl)
+       if (hw_lvl == dev->otx2_tm_root_lvl)
                parent = tm_node->parent_hw_id;
        else
                parent = tm_node->parent->hw_id;
 
        /* Do we need this trigger to configure TL1 */
        if (dev->otx2_tm_root_lvl == NIX_TXSCH_LVL_TL2 &&
-           tm_node->hw_lvl_id == dev->otx2_tm_root_lvl) {
-               schq = parent;
-               /*
-                * Default config for TL1.
-                * For VF this is always ignored.
-                */
-
-               req = otx2_mbox_alloc_msg_nix_txschq_cfg(mbox);
-               req->lvl = NIX_TXSCH_LVL_TL1;
-
-               /* Set DWRR quantum */
-               req->reg[0] = NIX_AF_TL1X_SCHEDULE(schq);
-               req->regval[0] = TXSCH_TL1_DFLT_RR_QTM;
-               req->num_regs++;
-
-               req->reg[1] = NIX_AF_TL1X_TOPOLOGY(schq);
-               req->regval[1] = (TXSCH_TL1_DFLT_RR_PRIO << 1);
-               req->num_regs++;
-
-               req->reg[2] = NIX_AF_TL1X_CIR(schq);
-               req->regval[2] = 0;
-               req->num_regs++;
-
-               rc = send_tm_reqval(mbox, req);
+           hw_lvl == dev->otx2_tm_root_lvl) {
+               rc = populate_tm_tl1_default(dev, parent);
                if (rc)
                        goto error;
        }
 
-       if (tm_node->hw_lvl_id != NIX_TXSCH_LVL_SMQ)
+       if (hw_lvl != NIX_TXSCH_LVL_SMQ)
                child = find_prio_anchor(dev, tm_node->id);
 
-       rr_prio = tm_node->rr_prio;
-       hw_lvl = tm_node->hw_lvl_id;
-       strict_schedul_prio = tm_node->priority;
-       schq = tm_node->hw_id;
-       rr_quantum = (tm_node->weight * NIX_TM_RR_QUANTUM_MAX) /
-               MAX_SCHED_WEIGHT;
-
-       configure_shaper_cir_pir_reg(dev, tm_node, &cir, &pir);
-
-       otx2_tm_dbg("Configure node %p, lvl %u hw_lvl %u, id %u, hw_id %u,"
-                    "parent_hw_id %" PRIx64 ", pir %" PRIx64 ", cir %" PRIx64,
-                    tm_node, tm_node->level_id, hw_lvl,
-                    tm_node->id, schq, parent, pir.rate, cir.rate);
+       /* Override default rr_prio when TL1
+        * Static Priority is disabled
+        */
+       if (hw_lvl == NIX_TXSCH_LVL_TL1 &&
+           dev->tm_flags & NIX_TM_TL1_NO_SP) {
+               rr_prio = TXSCH_TL1_DFLT_RR_PRIO;
+               child = 0;
+       }
 
-       rc = -EFAULT;
+       otx2_tm_dbg("Topology config node %s(%u)->%s(%"PRIu64") lvl %u, id %u"
+                   " prio_anchor %"PRIu64" rr_prio %u (%p)",
+                   nix_hwlvl2str(hw_lvl), schq, nix_hwlvl2str(hw_lvl + 1),
+                   parent, tm_node->lvl, tm_node->id, child, rr_prio, tm_node);
 
+       /* Prepare Topology and Link config */
        switch (hw_lvl) {
        case NIX_TXSCH_LVL_SMQ:
-               req = otx2_mbox_alloc_msg_nix_txschq_cfg(mbox);
-               req->lvl = hw_lvl;
-               reg = req->reg;
-               regval = req->regval;
-               req->num_regs = 0;
 
                /* Set xoff which will be cleared later */
-               *reg++ = NIX_AF_SMQX_CFG(schq);
-               *regval++ = BIT_ULL(50) | ((uint64_t)NIX_MAX_VTAG_INS << 36) |
-                               (NIX_MAX_HW_FRS << 8) | NIX_MIN_HW_FRS;
-               req->num_regs++;
-               *reg++ = NIX_AF_MDQX_PARENT(schq);
-               *regval++ = parent << 16;
-               req->num_regs++;
-               *reg++ = NIX_AF_MDQX_SCHEDULE(schq);
-               *regval++ = (strict_schedul_prio << 24) | rr_quantum;
-               req->num_regs++;
-               if (pir.rate && pir.burst) {
-                       *reg++ = NIX_AF_MDQX_PIR(schq);
-                       *regval++ = shaper2regval(&pir) | 1;
-                       req->num_regs++;
-               }
+               reg[k] = NIX_AF_SMQX_CFG(schq);
+               regval[k] = BIT_ULL(50);
+               regval_mask[k] = ~BIT_ULL(50);
+               k++;
 
-               if (cir.rate && cir.burst) {
-                       *reg++ = NIX_AF_MDQX_CIR(schq);
-                       *regval++ = shaper2regval(&cir) | 1;
-                       req->num_regs++;
-               }
+               /* Parent and schedule conf */
+               reg[k] = NIX_AF_MDQX_PARENT(schq);
+               regval[k] = parent << 16;
+               k++;
 
-               rc = send_tm_reqval(mbox, req);
-               if (rc)
-                       goto error;
                break;
        case NIX_TXSCH_LVL_TL4:
-               req = otx2_mbox_alloc_msg_nix_txschq_cfg(mbox);
-               req->lvl = hw_lvl;
-               req->num_regs = 0;
-               reg = req->reg;
-               regval = req->regval;
-
-               *reg++ = NIX_AF_TL4X_PARENT(schq);
-               *regval++ = parent << 16;
-               req->num_regs++;
-               *reg++ = NIX_AF_TL4X_TOPOLOGY(schq);
-               *regval++ = (child << 32) | (rr_prio << 1);
-               req->num_regs++;
-               *reg++ = NIX_AF_TL4X_SCHEDULE(schq);
-               *regval++ = (strict_schedul_prio << 24) | rr_quantum;
-               req->num_regs++;
-               if (pir.rate && pir.burst) {
-                       *reg++ = NIX_AF_TL4X_PIR(schq);
-                       *regval++ = shaper2regval(&pir) | 1;
-                       req->num_regs++;
-               }
-               if (cir.rate && cir.burst) {
-                       *reg++ = NIX_AF_TL4X_CIR(schq);
-                       *regval++ = shaper2regval(&cir) | 1;
-                       req->num_regs++;
-               }
+               /* Parent and schedule conf */
+               reg[k] = NIX_AF_TL4X_PARENT(schq);
+               regval[k] = parent << 16;
+               k++;
+
+               reg[k] = NIX_AF_TL4X_TOPOLOGY(schq);
+               regval[k] = (child << 32) | (rr_prio << 1);
+               k++;
+
                /* Configure TL4 to send to SDP channel instead of CGX/LBK */
                if (otx2_dev_is_sdp(dev)) {
-                       *reg++ = NIX_AF_TL4X_SDP_LINK_CFG(schq);
-                       *regval++ = BIT_ULL(12);
-                       req->num_regs++;
+                       reg[k] = NIX_AF_TL4X_SDP_LINK_CFG(schq);
+                       regval[k] = BIT_ULL(12);
+                       k++;
                }
-
-               rc = send_tm_reqval(mbox, req);
-               if (rc)
-                       goto error;
                break;
        case NIX_TXSCH_LVL_TL3:
-               req = otx2_mbox_alloc_msg_nix_txschq_cfg(mbox);
-               req->lvl = hw_lvl;
-               req->num_regs = 0;
-               reg = req->reg;
-               regval = req->regval;
-
-               *reg++ = NIX_AF_TL3X_PARENT(schq);
-               *regval++ = parent << 16;
-               req->num_regs++;
-               *reg++ = NIX_AF_TL3X_TOPOLOGY(schq);
-               *regval++ = (child << 32) | (rr_prio << 1);
-               req->num_regs++;
-               *reg++ = NIX_AF_TL3X_SCHEDULE(schq);
-               *regval++ = (strict_schedul_prio << 24) | rr_quantum;
-               req->num_regs++;
+               /* Parent and schedule conf */
+               reg[k] = NIX_AF_TL3X_PARENT(schq);
+               regval[k] = parent << 16;
+               k++;
+
+               reg[k] = NIX_AF_TL3X_TOPOLOGY(schq);
+               regval[k] = (child << 32) | (rr_prio << 1);
+               k++;
 
                /* Link configuration */
                if (!otx2_dev_is_sdp(dev) &&
                    dev->link_cfg_lvl == NIX_TXSCH_LVL_TL3) {
-                       *reg++ = NIX_AF_TL3_TL2X_LINKX_CFG(schq,
+                       reg[k] = NIX_AF_TL3_TL2X_LINKX_CFG(schq,
                                                nix_get_link(dev));
-                       *regval++ = BIT_ULL(12) | nix_get_relchan(dev);
-                       req->num_regs++;
-               }
-
-               if (pir.rate && pir.burst) {
-                       *reg++ = NIX_AF_TL3X_PIR(schq);
-                       *regval++ = shaper2regval(&pir) | 1;
-                       req->num_regs++;
-               }
-               if (cir.rate && cir.burst) {
-                       *reg++ = NIX_AF_TL3X_CIR(schq);
-                       *regval++ = shaper2regval(&cir) | 1;
-                       req->num_regs++;
+                       regval[k] = BIT_ULL(12) | nix_get_relchan(dev);
+                       k++;
                }
 
-               rc = send_tm_reqval(mbox, req);
-               if (rc)
-                       goto error;
                break;
        case NIX_TXSCH_LVL_TL2:
-               req = otx2_mbox_alloc_msg_nix_txschq_cfg(mbox);
-               req->lvl = hw_lvl;
-               req->num_regs = 0;
-               reg = req->reg;
-               regval = req->regval;
-
-               *reg++ = NIX_AF_TL2X_PARENT(schq);
-               *regval++ = parent << 16;
-               req->num_regs++;
-               *reg++ = NIX_AF_TL2X_TOPOLOGY(schq);
-               *regval++ = (child << 32) | (rr_prio << 1);
-               req->num_regs++;
-               *reg++ = NIX_AF_TL2X_SCHEDULE(schq);
-               if (dev->otx2_tm_root_lvl == NIX_TXSCH_LVL_TL2)
-                       *regval++ = (1 << 24) | rr_quantum;
-               else
-                       *regval++ = (strict_schedul_prio << 24) | rr_quantum;
-               req->num_regs++;
+               /* Parent and schedule conf */
+               reg[k] = NIX_AF_TL2X_PARENT(schq);
+               regval[k] = parent << 16;
+               k++;
+
+               reg[k] = NIX_AF_TL2X_TOPOLOGY(schq);
+               regval[k] = (child << 32) | (rr_prio << 1);
+               k++;
 
                /* Link configuration */
                if (!otx2_dev_is_sdp(dev) &&
                    dev->link_cfg_lvl == NIX_TXSCH_LVL_TL2) {
-                       *reg++ = NIX_AF_TL3_TL2X_LINKX_CFG(schq,
+                       reg[k] = NIX_AF_TL3_TL2X_LINKX_CFG(schq,
                                                nix_get_link(dev));
-                       *regval++ = BIT_ULL(12) | nix_get_relchan(dev);
-                       req->num_regs++;
-               }
-               if (pir.rate && pir.burst) {
-                       *reg++ = NIX_AF_TL2X_PIR(schq);
-                       *regval++ = shaper2regval(&pir) | 1;
-                       req->num_regs++;
-               }
-               if (cir.rate && cir.burst) {
-                       *reg++ = NIX_AF_TL2X_CIR(schq);
-                       *regval++ = shaper2regval(&cir) | 1;
-                       req->num_regs++;
+                       regval[k] = BIT_ULL(12) | nix_get_relchan(dev);
+                       k++;
                }
 
-               rc = send_tm_reqval(mbox, req);
-               if (rc)
-                       goto error;
                break;
        case NIX_TXSCH_LVL_TL1:
-               req = otx2_mbox_alloc_msg_nix_txschq_cfg(mbox);
-               req->lvl = hw_lvl;
-               req->num_regs = 0;
-               reg = req->reg;
-               regval = req->regval;
-
-               *reg++ = NIX_AF_TL1X_SCHEDULE(schq);
-               *regval++ = rr_quantum;
-               req->num_regs++;
-               *reg++ = NIX_AF_TL1X_TOPOLOGY(schq);
-               *regval++ = (child << 32) | (rr_prio << 1 /*RR_PRIO*/);
-               req->num_regs++;
-               if (cir.rate && cir.burst) {
-                       *reg++ = NIX_AF_TL1X_CIR(schq);
-                       *regval++ = shaper2regval(&cir) | 1;
-                       req->num_regs++;
-               }
+               reg[k] = NIX_AF_TL1X_TOPOLOGY(schq);
+               regval[k] = (child << 32) | (rr_prio << 1 /*RR_PRIO*/);
+               k++;
 
-               rc = send_tm_reqval(mbox, req);
-               if (rc)
-                       goto error;
                break;
        }
 
+       /* Prepare schedule config */
+       k += prepare_tm_sched_reg(dev, tm_node, &reg[k], &regval[k]);
+
+       /* Prepare shaping config */
+       k += prepare_tm_shaper_reg(tm_node, profile, &reg[k], &regval[k]);
+
+       if (!k)
+               return 0;
+
+       /* Copy and send config mbox */
+       req = otx2_mbox_alloc_msg_nix_txschq_cfg(mbox);
+       req->lvl = hw_lvl;
+       req->num_regs = k;
+
+       otx2_mbox_memcpy(req->reg, reg, sizeof(uint64_t) * k);
+       otx2_mbox_memcpy(req->regval, regval, sizeof(uint64_t) * k);
+       otx2_mbox_memcpy(req->regval_mask, regval_mask, sizeof(uint64_t) * k);
+
+       rc = otx2_mbox_process(mbox);
+       if (rc)
+               goto error;
+
        return 0;
 error:
        otx2_err("Txschq cfg request failed for node %p, rc=%d", tm_node, rc);
@@ -541,13 +591,14 @@ static int
 nix_tm_txsch_reg_config(struct otx2_eth_dev *dev)
 {
        struct otx2_nix_tm_node *tm_node;
-       uint32_t lvl;
+       uint32_t hw_lvl;
        int rc = 0;
 
-       for (lvl = 0; lvl < (uint32_t)dev->otx2_tm_root_lvl + 1; lvl++) {
+       for (hw_lvl = 0; hw_lvl <= dev->otx2_tm_root_lvl; hw_lvl++) {
                TAILQ_FOREACH(tm_node, &dev->node_list, node) {
-                       if (tm_node->hw_lvl_id == lvl) {
-                               rc = populate_tm_registers(dev, tm_node);
+                       if (tm_node->hw_lvl == hw_lvl &&
+                           tm_node->hw_lvl != NIX_TXSCH_LVL_CNT) {
+                               rc = populate_tm_reg(dev, tm_node);
                                if (rc)
                                        goto exit;
                        }
@@ -637,8 +688,8 @@ nix_tm_update_parent_info(struct otx2_eth_dev *dev)
 static int
 nix_tm_node_add_to_list(struct otx2_eth_dev *dev, uint32_t node_id,
                        uint32_t parent_node_id, uint32_t priority,
-                       uint32_t weight, uint16_t hw_lvl_id,
-                       uint16_t level_id, bool user,
+                       uint32_t weight, uint16_t hw_lvl,
+                       uint16_t lvl, bool user,
                        struct rte_tm_node_params *params)
 {
        struct otx2_nix_tm_shaper_profile *shaper_profile;
@@ -655,8 +706,8 @@ nix_tm_node_add_to_list(struct otx2_eth_dev *dev, uint32_t node_id,
        if (!tm_node)
                return -ENOMEM;
 
-       tm_node->level_id = level_id;
-       tm_node->hw_lvl_id = hw_lvl_id;
+       tm_node->lvl = lvl;
+       tm_node->hw_lvl = hw_lvl;
 
        tm_node->id = node_id;
        tm_node->priority = priority;
@@ -935,18 +986,18 @@ nix_tm_free_resources(struct otx2_eth_dev *dev, uint32_t flags_mask,
                        continue;
 
                if (nix_tm_have_tl1_access(dev) &&
-                   tm_node->hw_lvl_id ==  NIX_TXSCH_LVL_TL1)
+                   tm_node->hw_lvl ==  NIX_TXSCH_LVL_TL1)
                        skip_node = true;
 
                otx2_tm_dbg("Free hwres for node %u, hwlvl %u, hw_id %u (%p)",
-                           tm_node->id,  tm_node->hw_lvl_id,
+                           tm_node->id,  tm_node->hw_lvl,
                            tm_node->hw_id, tm_node);
                /* Free specific HW resource if requested */
                if (!skip_node && flags_mask &&
                    tm_node->flags & NIX_TM_NODE_HWRES) {
                        req = otx2_mbox_alloc_msg_nix_txsch_free(mbox);
                        req->flags = 0;
-                       req->schq_lvl = tm_node->hw_lvl_id;
+                       req->schq_lvl = tm_node->hw_lvl;
                        req->schq = tm_node->hw_id;
                        rc = otx2_mbox_process(mbox);
                        if (rc)
@@ -1010,17 +1061,17 @@ nix_tm_assign_id_to_node(struct otx2_eth_dev *dev,
        uint32_t l_id, schq_index;
 
        otx2_tm_dbg("Assign hw id for child node %u, lvl %u, hw_lvl %u (%p)",
-                   child->id, child->level_id, child->hw_lvl_id, child);
+                   child->id, child->lvl, child->hw_lvl, child);
 
        child->flags |= NIX_TM_NODE_HWRES;
 
        /* Process root nodes */
        if (dev->otx2_tm_root_lvl == NIX_TXSCH_LVL_TL2 &&
-           child->hw_lvl_id == dev->otx2_tm_root_lvl && !parent) {
+           child->hw_lvl == dev->otx2_tm_root_lvl && !parent) {
                int idx = 0;
                uint32_t tschq_con_index;
 
-               l_id = child->hw_lvl_id;
+               l_id = child->hw_lvl;
                tschq_con_index = dev->txschq_contig_index[l_id];
                hw_id = dev->txschq_contig_list[l_id][tschq_con_index];
                child->hw_id = hw_id;
@@ -1032,10 +1083,10 @@ nix_tm_assign_id_to_node(struct otx2_eth_dev *dev,
                return 0;
        }
        if (dev->otx2_tm_root_lvl == NIX_TXSCH_LVL_TL1 &&
-           child->hw_lvl_id == dev->otx2_tm_root_lvl && !parent) {
+           child->hw_lvl == dev->otx2_tm_root_lvl && !parent) {
                uint32_t tschq_con_index;
 
-               l_id = child->hw_lvl_id;
+               l_id = child->hw_lvl;
                tschq_con_index = dev->txschq_index[l_id];
                hw_id = dev->txschq_list[l_id][tschq_con_index];
                child->hw_id = hw_id;
@@ -1044,7 +1095,7 @@ nix_tm_assign_id_to_node(struct otx2_eth_dev *dev,
        }
 
        /* Process children with parents */
-       l_id = child->hw_lvl_id;
+       l_id = child->hw_lvl;
        schq_index = dev->txschq_index[l_id];
        schq_con_index = dev->txschq_contig_index[l_id];
 
@@ -1069,8 +1120,8 @@ nix_tm_assign_hw_id(struct otx2_eth_dev *dev)
 
        for (i = NIX_TXSCH_LVL_TL1; i > 0; i--) {
                TAILQ_FOREACH(parent, &dev->node_list, node) {
-                       child_hw_lvl = parent->hw_lvl_id - 1;
-                       if (parent->hw_lvl_id != i)
+                       child_hw_lvl = parent->hw_lvl - 1;
+                       if (parent->hw_lvl != i)
                                continue;
                        TAILQ_FOREACH(child, &dev->node_list, node) {
                                if (!child->parent)
@@ -1087,7 +1138,7 @@ nix_tm_assign_hw_id(struct otx2_eth_dev *dev)
                         * Explicitly assign id to parent node if it
                         * doesn't have a parent
                         */
-                       if (parent->hw_lvl_id == dev->otx2_tm_root_lvl)
+                       if (parent->hw_lvl == dev->otx2_tm_root_lvl)
                                nix_tm_assign_id_to_node(dev, parent, NULL);
                }
        }
@@ -1102,7 +1153,7 @@ nix_tm_count_req_schq(struct otx2_eth_dev *dev,
        uint8_t contig_count;
 
        TAILQ_FOREACH(tm_node, &dev->node_list, node) {
-               if (lvl == tm_node->hw_lvl_id) {
+               if (lvl == tm_node->hw_lvl) {
                        req->schq[lvl - 1] += tm_node->rr_num;
                        if (tm_node->max_prio != UINT32_MAX) {
                                contig_count = tm_node->max_prio + 1;
@@ -1111,7 +1162,7 @@ nix_tm_count_req_schq(struct otx2_eth_dev *dev,
                }
                if (lvl == dev->otx2_tm_root_lvl &&
                    dev->otx2_tm_root_lvl && lvl == NIX_TXSCH_LVL_TL2 &&
-                   tm_node->hw_lvl_id == dev->otx2_tm_root_lvl) {
+                   tm_node->hw_lvl == dev->otx2_tm_root_lvl) {
                        req->schq_contig[dev->otx2_tm_root_lvl]++;
                }
        }
@@ -1192,7 +1243,7 @@ nix_tm_alloc_resources(struct rte_eth_dev *eth_dev, bool xmit_enable)
                        continue;
 
                /* Enable xmit on sq */
-               if (tm_node->level_id != OTX2_TM_LVL_QUEUE) {
+               if (tm_node->lvl != OTX2_TM_LVL_QUEUE) {
                        tm_node->flags |= NIX_TM_NODE_ENABLED;
                        continue;
                }
@@ -1210,8 +1261,7 @@ nix_tm_alloc_resources(struct rte_eth_dev *eth_dev, bool xmit_enable)
                txq = eth_dev->data->tx_queues[sq];
 
                smq = tm_node->parent->hw_id;
-               rr_quantum = (tm_node->weight *
-                             NIX_TM_RR_QUANTUM_MAX) / MAX_SCHED_WEIGHT;
+               rr_quantum = NIX_TM_WEIGHT_TO_RR_QUANTUM(tm_node->weight);
 
                rc = nix_tm_sw_xon(txq, smq, rr_quantum);
                if (rc)
@@ -1332,6 +1382,7 @@ void otx2_nix_tm_conf_init(struct rte_eth_dev *eth_dev)
 
 int otx2_nix_tm_init_default(struct rte_eth_dev *eth_dev)
 {
+       struct rte_pci_device *pci_dev = RTE_ETH_DEV_TO_PCI(eth_dev);
        struct otx2_eth_dev  *dev = otx2_eth_pmd_priv(eth_dev);
        uint16_t sq_cnt = eth_dev->data->nb_tx_queues;
        int rc;
@@ -1347,6 +1398,13 @@ int otx2_nix_tm_init_default(struct rte_eth_dev *eth_dev)
        nix_tm_clear_shaper_profiles(dev);
        dev->tm_flags = NIX_TM_DEFAULT_TREE;
 
+       /* Disable TL1 Static Priority when VF's are enabled
+        * as otherwise VF's TL2 reallocation will be needed
+        * runtime to support a specific topology of PF.
+        */
+       if (pci_dev->max_vfs)
+               dev->tm_flags |= NIX_TM_TL1_NO_SP;
+
        rc = nix_tm_prepare_default_tree(eth_dev);
        if (rc != 0)
                return rc;
@@ -1397,15 +1455,14 @@ otx2_nix_tm_get_leaf_data(struct otx2_eth_dev *dev, uint16_t sq,
                tm_node = nix_tm_node_search(dev, sq, true);
 
        /* Check if we found a valid leaf node */
-       if (!tm_node || tm_node->level_id != OTX2_TM_LVL_QUEUE ||
+       if (!tm_node || tm_node->lvl != OTX2_TM_LVL_QUEUE ||
            !tm_node->parent || tm_node->parent->hw_id == UINT32_MAX) {
                return -EIO;
        }
 
        /* Get SMQ Id of leaf node's parent */
        *smq = tm_node->parent->hw_id;
-       *rr_quantum = (tm_node->weight * NIX_TM_RR_QUANTUM_MAX)
-               / MAX_SCHED_WEIGHT;
+       *rr_quantum = NIX_TM_WEIGHT_TO_RR_QUANTUM(tm_node->weight);
 
        rc = nix_smq_xoff(dev, *smq, false);
        if (rc)
index 4712b09..ad7727e 100644 (file)
@@ -10,6 +10,7 @@
 #include <rte_tm_driver.h>
 
 #define NIX_TM_DEFAULT_TREE    BIT_ULL(0)
+#define NIX_TM_TL1_NO_SP       BIT_ULL(3)
 
 struct otx2_eth_dev;
 
@@ -27,16 +28,18 @@ struct otx2_nix_tm_node {
        uint32_t hw_id;
        uint32_t priority;
        uint32_t weight;
-       uint16_t level_id;
-       uint16_t hw_lvl_id;
+       uint16_t lvl;
+       uint16_t hw_lvl;
        uint32_t rr_prio;
        uint32_t rr_num;
        uint32_t max_prio;
        uint32_t parent_hw_id;
-       uint32_t flags;
+       uint32_t flags:16;
 #define NIX_TM_NODE_HWRES      BIT_ULL(0)
 #define NIX_TM_NODE_ENABLED    BIT_ULL(1)
 #define NIX_TM_NODE_USER       BIT_ULL(2)
+       /* Shaper algorithm for RED state @NIX_REDALG_E */
+       uint32_t red_algo:2;
        struct otx2_nix_tm_node *parent;
        struct rte_tm_node_params params;
 };
@@ -45,7 +48,7 @@ struct otx2_nix_tm_shaper_profile {
        TAILQ_ENTRY(otx2_nix_tm_shaper_profile) shaper;
        uint32_t shaper_profile_id;
        uint32_t reference_count;
-       struct rte_tm_shaper_params profile;
+       struct rte_tm_shaper_params params; /* Rate in bits/sec */
 };
 
 struct shaper_params {
@@ -63,6 +66,10 @@ TAILQ_HEAD(otx2_nix_tm_shaper_profile_list, otx2_nix_tm_shaper_profile);
 
 #define MAX_SCHED_WEIGHT ((uint8_t)~0)
 #define NIX_TM_RR_QUANTUM_MAX (BIT_ULL(24) - 1)
+#define NIX_TM_WEIGHT_TO_RR_QUANTUM(__weight)                  \
+               ((((__weight) & MAX_SCHED_WEIGHT) *             \
+                 NIX_TM_RR_QUANTUM_MAX) / MAX_SCHED_WEIGHT)
+
 
 /* DEFAULT_RR_WEIGHT * NIX_TM_RR_QUANTUM_MAX / MAX_SCHED_WEIGHT  */
 /* = NIX_MAX_HW_MTU */
@@ -73,52 +80,27 @@ TAILQ_HEAD(otx2_nix_tm_shaper_profile_list, otx2_nix_tm_shaper_profile);
 #define MAX_RATE_EXPONENT 0xf
 #define MAX_RATE_MANTISSA 0xff
 
-/** NIX rate limiter time-wheel resolution */
-#define L1_TIME_WHEEL_CCLK_TICKS 240
-#define LX_TIME_WHEEL_CCLK_TICKS 860
-
-#define CCLK_HZ 1000000000
+#define NIX_SHAPER_RATE_CONST ((uint64_t)2E6)
 
-/* NIX rate calculation
- *     CCLK = coprocessor-clock frequency in MHz
- *     CCLK_TICKS = rate limiter time-wheel resolution
- *
+/* NIX rate calculation in Bits/Sec
  *     PIR_ADD = ((256 + NIX_*_PIR[RATE_MANTISSA])
  *             << NIX_*_PIR[RATE_EXPONENT]) / 256
- *     PIR = (CCLK / (CCLK_TICKS << NIX_*_PIR[RATE_DIVIDER_EXPONENT]))
- *             * PIR_ADD
+ *     PIR = (2E6 * PIR_ADD / (1 << NIX_*_PIR[RATE_DIVIDER_EXPONENT]))
  *
  *     CIR_ADD = ((256 + NIX_*_CIR[RATE_MANTISSA])
  *             << NIX_*_CIR[RATE_EXPONENT]) / 256
- *     CIR = (CCLK / (CCLK_TICKS << NIX_*_CIR[RATE_DIVIDER_EXPONENT]))
- *             * CIR_ADD
+ *     CIR = (2E6 * CIR_ADD / (CCLK_TICKS << NIX_*_CIR[RATE_DIVIDER_EXPONENT]))
  */
-#define SHAPER_RATE(cclk_hz, cclk_ticks, \
-                       exponent, mantissa, div_exp) \
-       (((uint64_t)(cclk_hz) * ((256 + (mantissa)) << (exponent))) \
-               / (((cclk_ticks) << (div_exp)) * 256))
-
-#define L1_SHAPER_RATE(cclk_hz, exponent, mantissa, div_exp) \
-       SHAPER_RATE(cclk_hz, L1_TIME_WHEEL_CCLK_TICKS, \
-                       exponent, mantissa, div_exp)
+#define SHAPER_RATE(exponent, mantissa, div_exp) \
+       ((NIX_SHAPER_RATE_CONST * ((256 + (mantissa)) << (exponent)))\
+               / (((1ull << (div_exp)) * 256)))
 
-#define LX_SHAPER_RATE(cclk_hz, exponent, mantissa, div_exp) \
-       SHAPER_RATE(cclk_hz, LX_TIME_WHEEL_CCLK_TICKS, \
-                       exponent, mantissa, div_exp)
+/* 96xx rate limits in Bits/Sec */
+#define MIN_SHAPER_RATE \
+       SHAPER_RATE(0, 0, MAX_RATE_DIV_EXP)
 
-/* Shaper rate limits */
-#define MIN_SHAPER_RATE(cclk_hz, cclk_ticks) \
-       SHAPER_RATE(cclk_hz, cclk_ticks, 0, 0, MAX_RATE_DIV_EXP)
-
-#define MAX_SHAPER_RATE(cclk_hz, cclk_ticks) \
-       SHAPER_RATE(cclk_hz, cclk_ticks, MAX_RATE_EXPONENT, \
-                       MAX_RATE_MANTISSA, 0)
-
-#define MIN_L1_SHAPER_RATE(cclk_hz) \
-       MIN_SHAPER_RATE(cclk_hz, L1_TIME_WHEEL_CCLK_TICKS)
-
-#define MAX_L1_SHAPER_RATE(cclk_hz) \
-       MAX_SHAPER_RATE(cclk_hz, L1_TIME_WHEEL_CCLK_TICKS)
+#define MAX_SHAPER_RATE \
+       SHAPER_RATE(MAX_RATE_EXPONENT, MAX_RATE_MANTISSA, 0)
 
 /** TM Shaper - low level operations */
 
@@ -150,4 +132,25 @@ TAILQ_HEAD(otx2_nix_tm_shaper_profile_list, otx2_nix_tm_shaper_profile);
 #define TXSCH_TL1_DFLT_RR_QTM  ((1 << 24) - 1)
 #define TXSCH_TL1_DFLT_RR_PRIO 1
 
+static inline const char *
+nix_hwlvl2str(uint32_t hw_lvl)
+{
+       switch (hw_lvl) {
+       case NIX_TXSCH_LVL_MDQ:
+               return "SMQ/MDQ";
+       case NIX_TXSCH_LVL_TL4:
+               return "TL4";
+       case NIX_TXSCH_LVL_TL3:
+               return "TL3";
+       case NIX_TXSCH_LVL_TL2:
+               return "TL2";
+       case NIX_TXSCH_LVL_TL1:
+               return "TL1";
+       default:
+               break;
+       }
+
+       return "???";
+}
+
 #endif /* __OTX2_TM_H__ */