LCOV - code coverage report
Current view: top level - drivers/bus/fslmc/qbman - qbman_debug.c (source / functions) Hit Total Coverage
Test: Code coverage Lines: 0 218 0.0 %
Date: 2024-02-14 00:53:57 Functions: 0 74 0.0 %
Legend: Lines: hit not hit | Branches: + taken - not taken # not executed Branches: 0 44 0.0 %

           Branch data     Line data    Source code
       1                 :            : /* SPDX-License-Identifier: BSD-3-Clause
       2                 :            :  * Copyright (C) 2015 Freescale Semiconductor, Inc.
       3                 :            :  * Copyright 2018-2020 NXP
       4                 :            :  */
       5                 :            : 
       6                 :            : #include "compat.h"
       7                 :            : #include <fsl_qbman_debug.h>
       8                 :            : #include "qbman_portal.h"
       9                 :            : 
      10                 :            : /* QBMan portal management command code */
      11                 :            : #define QBMAN_BP_QUERY            0x32
      12                 :            : #define QBMAN_FQ_QUERY            0x44
      13                 :            : #define QBMAN_FQ_QUERY_NP         0x45
      14                 :            : #define QBMAN_WQ_QUERY            0x47
      15                 :            : #define QBMAN_CGR_QUERY           0x51
      16                 :            : #define QBMAN_WRED_QUERY          0x54
      17                 :            : #define QBMAN_CGR_STAT_QUERY      0x55
      18                 :            : #define QBMAN_CGR_STAT_QUERY_CLR  0x56
      19                 :            : 
      20                 :            : struct qbman_bp_query_desc {
      21                 :            :         uint8_t verb;
      22                 :            :         uint8_t reserved;
      23                 :            :         uint16_t bpid;
      24                 :            :         uint8_t reserved2[60];
      25                 :            : };
      26                 :            : 
      27                 :            : #define QB_BP_STATE_SHIFT  24
      28                 :            : #define QB_BP_VA_SHIFT     1
      29                 :            : #define QB_BP_VA_MASK      0x2
      30                 :            : #define QB_BP_WAE_SHIFT    2
      31                 :            : #define QB_BP_WAE_MASK     0x4
      32                 :            : #define QB_BP_PL_SHIFT     15
      33                 :            : #define QB_BP_PL_MASK      0x8000
      34                 :            : #define QB_BP_ICID_MASK    0x7FFF
      35                 :            : 
      36                 :          0 : int qbman_bp_query(struct qbman_swp *s, uint32_t bpid,
      37                 :            :                    struct qbman_bp_query_rslt *r)
      38                 :            : {
      39                 :            :         struct qbman_bp_query_desc *p;
      40                 :            : 
      41                 :            :         /* Start the management command */
      42                 :          0 :         p = (struct qbman_bp_query_desc *)qbman_swp_mc_start(s);
      43         [ #  # ]:          0 :         if (!p)
      44                 :            :                 return -EBUSY;
      45                 :            : 
      46                 :            :         /* Encode the caller-provided attributes */
      47                 :          0 :         p->bpid = bpid;
      48                 :            : 
      49                 :            :         /* Complete the management command */
      50                 :          0 :         *r = *(struct qbman_bp_query_rslt *)qbman_swp_mc_complete(s, p,
      51                 :            :                                                  QBMAN_BP_QUERY);
      52                 :            :         if (!r) {
      53                 :            :                 pr_err("qbman: Query BPID %d failed, no response\n",
      54                 :            :                         bpid);
      55                 :            :                 return -EIO;
      56                 :            :         }
      57                 :            : 
      58                 :            :         /* Decode the outcome */
      59                 :            :         QBMAN_BUG_ON((r->verb & QBMAN_RESPONSE_VERB_MASK) != QBMAN_BP_QUERY);
      60                 :            : 
      61                 :            :         /* Determine success or failure */
      62         [ #  # ]:          0 :         if (r->rslt != QBMAN_MC_RSLT_OK) {
      63                 :          0 :                 pr_err("Query of BPID 0x%x failed, code=0x%02x\n", bpid,
      64                 :            :                                                                 r->rslt);
      65                 :          0 :                 return -EIO;
      66                 :            :         }
      67                 :            : 
      68                 :            :         return 0;
      69                 :            : }
      70                 :            : 
      71                 :          0 : int qbman_bp_get_bdi(struct qbman_bp_query_rslt *r)
      72                 :            : {
      73                 :          0 :         return r->bdi & 1;
      74                 :            : }
      75                 :            : 
      76                 :          0 : int qbman_bp_get_va(struct qbman_bp_query_rslt *r)
      77                 :            : {
      78                 :          0 :         return (r->bdi & QB_BP_VA_MASK) >> QB_BP_VA_MASK;
      79                 :            : }
      80                 :            : 
      81                 :          0 : int qbman_bp_get_wae(struct qbman_bp_query_rslt *r)
      82                 :            : {
      83                 :          0 :         return (r->bdi & QB_BP_WAE_MASK) >> QB_BP_WAE_SHIFT;
      84                 :            : }
      85                 :            : 
      86                 :            : static uint16_t qbman_bp_thresh_to_value(uint16_t val)
      87                 :            : {
      88                 :          0 :         return (val & 0xff) << ((val & 0xf00) >> 8);
      89                 :            : }
      90                 :            : 
      91                 :          0 : uint16_t qbman_bp_get_swdet(struct qbman_bp_query_rslt  *r)
      92                 :            : {
      93                 :            : 
      94                 :          0 :         return qbman_bp_thresh_to_value(r->swdet);
      95                 :            : }
      96                 :            : 
      97                 :          0 : uint16_t qbman_bp_get_swdxt(struct qbman_bp_query_rslt  *r)
      98                 :            : {
      99                 :          0 :         return qbman_bp_thresh_to_value(r->swdxt);
     100                 :            : }
     101                 :            : 
     102                 :          0 : uint16_t qbman_bp_get_hwdet(struct qbman_bp_query_rslt  *r)
     103                 :            : {
     104                 :          0 :         return qbman_bp_thresh_to_value(r->hwdet);
     105                 :            : }
     106                 :            : 
     107                 :          0 : uint16_t qbman_bp_get_hwdxt(struct qbman_bp_query_rslt  *r)
     108                 :            : {
     109                 :          0 :         return qbman_bp_thresh_to_value(r->hwdxt);
     110                 :            : }
     111                 :            : 
     112                 :          0 : uint16_t qbman_bp_get_swset(struct qbman_bp_query_rslt  *r)
     113                 :            : {
     114                 :          0 :         return qbman_bp_thresh_to_value(r->swset);
     115                 :            : }
     116                 :            : 
     117                 :          0 : uint16_t qbman_bp_get_swsxt(struct qbman_bp_query_rslt  *r)
     118                 :            : {
     119                 :            : 
     120                 :          0 :         return qbman_bp_thresh_to_value(r->swsxt);
     121                 :            : }
     122                 :            : 
     123                 :          0 : uint16_t qbman_bp_get_vbpid(struct qbman_bp_query_rslt  *r)
     124                 :            : {
     125                 :          0 :         return r->vbpid;
     126                 :            : }
     127                 :            : 
     128                 :          0 : uint16_t qbman_bp_get_icid(struct qbman_bp_query_rslt  *r)
     129                 :            : {
     130                 :          0 :         return r->icid & QB_BP_ICID_MASK;
     131                 :            : }
     132                 :            : 
     133                 :          0 : int qbman_bp_get_pl(struct qbman_bp_query_rslt  *r)
     134                 :            : {
     135                 :          0 :         return (r->icid & QB_BP_PL_MASK) >> QB_BP_PL_SHIFT;
     136                 :            : }
     137                 :            : 
     138                 :          0 : uint64_t qbman_bp_get_bpscn_addr(struct qbman_bp_query_rslt  *r)
     139                 :            : {
     140                 :          0 :         return r->bpscn_addr;
     141                 :            : }
     142                 :            : 
     143                 :          0 : uint64_t qbman_bp_get_bpscn_ctx(struct qbman_bp_query_rslt  *r)
     144                 :            : {
     145                 :          0 :         return r->bpscn_ctx;
     146                 :            : }
     147                 :            : 
     148                 :          0 : uint16_t qbman_bp_get_hw_targ(struct qbman_bp_query_rslt  *r)
     149                 :            : {
     150                 :          0 :         return r->hw_targ;
     151                 :            : }
     152                 :            : 
     153                 :          0 : int qbman_bp_has_free_bufs(struct qbman_bp_query_rslt  *r)
     154                 :            : {
     155                 :          0 :         return !(int)(r->state & 0x1);
     156                 :            : }
     157                 :            : 
     158                 :          0 : int qbman_bp_is_depleted(struct qbman_bp_query_rslt  *r)
     159                 :            : {
     160                 :          0 :         return (int)((r->state & 0x2) >> 1);
     161                 :            : }
     162                 :            : 
     163                 :          0 : int qbman_bp_is_surplus(struct qbman_bp_query_rslt  *r)
     164                 :            : {
     165                 :          0 :         return (int)((r->state & 0x4) >> 2);
     166                 :            : }
     167                 :            : 
     168                 :          0 : uint32_t qbman_bp_num_free_bufs(struct qbman_bp_query_rslt  *r)
     169                 :            : {
     170                 :          0 :         return r->fill;
     171                 :            : }
     172                 :            : 
     173                 :          0 : uint32_t qbman_bp_get_hdptr(struct qbman_bp_query_rslt  *r)
     174                 :            : {
     175                 :          0 :         return r->hdptr;
     176                 :            : }
     177                 :            : 
     178                 :          0 : uint32_t qbman_bp_get_sdcnt(struct qbman_bp_query_rslt  *r)
     179                 :            : {
     180                 :          0 :         return r->sdcnt;
     181                 :            : }
     182                 :            : 
     183                 :          0 : uint32_t qbman_bp_get_hdcnt(struct qbman_bp_query_rslt  *r)
     184                 :            : {
     185                 :          0 :         return r->hdcnt;
     186                 :            : }
     187                 :            : 
     188                 :          0 : uint32_t qbman_bp_get_sscnt(struct qbman_bp_query_rslt  *r)
     189                 :            : {
     190                 :          0 :         return r->sscnt;
     191                 :            : }
     192                 :            : 
     193                 :            : struct qbman_fq_query_desc {
     194                 :            :         uint8_t verb;
     195                 :            :         uint8_t reserved[3];
     196                 :            :         uint32_t fqid;
     197                 :            :         uint8_t reserved2[56];
     198                 :            : };
     199                 :            : 
     200                 :            : /* FQ query function for programmable fields */
     201                 :          0 : int qbman_fq_query(struct qbman_swp *s, uint32_t fqid,
     202                 :            :                    struct qbman_fq_query_rslt *r)
     203                 :            : {
     204                 :            :         struct qbman_fq_query_desc *p;
     205                 :            : 
     206                 :          0 :         p = (struct qbman_fq_query_desc *)qbman_swp_mc_start(s);
     207         [ #  # ]:          0 :         if (!p)
     208                 :            :                 return -EBUSY;
     209                 :            : 
     210                 :          0 :         p->fqid = fqid;
     211                 :          0 :         *r = *(struct qbman_fq_query_rslt *)qbman_swp_mc_complete(s, p,
     212                 :            :                                           QBMAN_FQ_QUERY);
     213                 :            :         if (!r) {
     214                 :            :                 pr_err("qbman: Query FQID %d failed, no response\n",
     215                 :            :                         fqid);
     216                 :            :                 return -EIO;
     217                 :            :         }
     218                 :            : 
     219                 :            :         /* Decode the outcome */
     220                 :            :         QBMAN_BUG_ON((r->verb & QBMAN_RESPONSE_VERB_MASK) != QBMAN_FQ_QUERY);
     221                 :            : 
     222                 :            :         /* Determine success or failure */
     223         [ #  # ]:          0 :         if (r->rslt != QBMAN_MC_RSLT_OK) {
     224                 :          0 :                 pr_err("Query of FQID 0x%x failed, code=0x%02x\n",
     225                 :            :                        fqid, r->rslt);
     226                 :          0 :                 return -EIO;
     227                 :            :         }
     228                 :            : 
     229                 :            :         return 0;
     230                 :            : }
     231                 :            : 
     232                 :          0 : uint8_t qbman_fq_attr_get_fqctrl(struct qbman_fq_query_rslt *r)
     233                 :            : {
     234                 :          0 :         return r->fq_ctrl;
     235                 :            : }
     236                 :            : 
     237                 :          0 : uint16_t qbman_fq_attr_get_cgrid(struct qbman_fq_query_rslt *r)
     238                 :            : {
     239                 :          0 :         return r->cgid;
     240                 :            : }
     241                 :            : 
     242                 :          0 : uint16_t qbman_fq_attr_get_destwq(struct qbman_fq_query_rslt *r)
     243                 :            : {
     244                 :          0 :         return r->dest_wq;
     245                 :            : }
     246                 :            : 
     247                 :            : static uint16_t qbman_thresh_to_value(uint16_t val)
     248                 :            : {
     249                 :          0 :         return ((val & 0x1FE0) >> 5) << (val & 0x1F);
     250                 :            : }
     251                 :            : 
     252                 :          0 : uint16_t qbman_fq_attr_get_tdthresh(struct qbman_fq_query_rslt *r)
     253                 :            : {
     254                 :          0 :         return qbman_thresh_to_value(r->td_thresh);
     255                 :            : }
     256                 :            : 
     257                 :          0 : int qbman_fq_attr_get_oa_ics(struct qbman_fq_query_rslt *r)
     258                 :            : {
     259                 :          0 :         return (int)(r->oal_oac >> 14) & 0x1;
     260                 :            : }
     261                 :            : 
     262                 :          0 : int qbman_fq_attr_get_oa_cgr(struct qbman_fq_query_rslt *r)
     263                 :            : {
     264                 :          0 :         return (int)(r->oal_oac >> 15);
     265                 :            : }
     266                 :            : 
     267                 :          0 : uint16_t qbman_fq_attr_get_oal(struct qbman_fq_query_rslt *r)
     268                 :            : {
     269                 :          0 :         return (r->oal_oac & 0x0FFF);
     270                 :            : }
     271                 :            : 
     272                 :          0 : int qbman_fq_attr_get_bdi(struct qbman_fq_query_rslt *r)
     273                 :            : {
     274                 :          0 :         return (r->mctl & 0x1);
     275                 :            : }
     276                 :            : 
     277                 :          0 : int qbman_fq_attr_get_ff(struct qbman_fq_query_rslt *r)
     278                 :            : {
     279                 :          0 :         return (r->mctl & 0x2) >> 1;
     280                 :            : }
     281                 :            : 
     282                 :          0 : int qbman_fq_attr_get_va(struct qbman_fq_query_rslt *r)
     283                 :            : {
     284                 :          0 :         return (r->mctl & 0x4) >> 2;
     285                 :            : }
     286                 :            : 
     287                 :          0 : int qbman_fq_attr_get_ps(struct qbman_fq_query_rslt *r)
     288                 :            : {
     289                 :          0 :         return (r->mctl & 0x8) >> 3;
     290                 :            : }
     291                 :            : 
     292                 :          0 : int qbman_fq_attr_get_pps(struct qbman_fq_query_rslt *r)
     293                 :            : {
     294                 :          0 :         return (r->mctl & 0x30) >> 4;
     295                 :            : }
     296                 :            : 
     297                 :          0 : uint16_t qbman_fq_attr_get_icid(struct qbman_fq_query_rslt *r)
     298                 :            : {
     299                 :          0 :         return r->icid & 0x7FFF;
     300                 :            : }
     301                 :            : 
     302                 :          0 : int qbman_fq_attr_get_pl(struct qbman_fq_query_rslt *r)
     303                 :            : {
     304                 :          0 :         return (int)((r->icid & 0x8000) >> 15);
     305                 :            : }
     306                 :            : 
     307                 :          0 : uint32_t qbman_fq_attr_get_vfqid(struct qbman_fq_query_rslt *r)
     308                 :            : {
     309                 :          0 :         return r->vfqid & 0x00FFFFFF;
     310                 :            : }
     311                 :            : 
     312                 :          0 : uint32_t qbman_fq_attr_get_erfqid(struct qbman_fq_query_rslt *r)
     313                 :            : {
     314                 :          0 :         return r->fqid_er & 0x00FFFFFF;
     315                 :            : }
     316                 :            : 
     317                 :          0 : uint16_t qbman_fq_attr_get_opridsz(struct qbman_fq_query_rslt *r)
     318                 :            : {
     319                 :          0 :         return r->opridsz;
     320                 :            : }
     321                 :            : 
     322                 :          0 : int qbman_fq_query_state(struct qbman_swp *s, uint32_t fqid,
     323                 :            :                          struct qbman_fq_query_np_rslt *r)
     324                 :            : {
     325                 :            :         struct qbman_fq_query_desc *p;
     326                 :            :         struct qbman_fq_query_np_rslt *var;
     327                 :            : 
     328                 :          0 :         p = (struct qbman_fq_query_desc *)qbman_swp_mc_start(s);
     329         [ #  # ]:          0 :         if (!p)
     330                 :            :                 return -EBUSY;
     331                 :            : 
     332                 :          0 :         p->fqid = fqid;
     333                 :          0 :         var = qbman_swp_mc_complete(s, p, QBMAN_FQ_QUERY_NP);
     334         [ #  # ]:          0 :         if (!var) {
     335                 :          0 :                 pr_err("qbman: Query FQID %d NP fields failed, no response\n",
     336                 :            :                        fqid);
     337                 :          0 :                 return -EIO;
     338                 :            :         }
     339                 :          0 :         *r = *var;
     340                 :            : 
     341                 :            :         /* Decode the outcome */
     342                 :            :         QBMAN_BUG_ON((r->verb & QBMAN_RESPONSE_VERB_MASK) != QBMAN_FQ_QUERY_NP);
     343                 :            : 
     344                 :            :         /* Determine success or failure */
     345         [ #  # ]:          0 :         if (r->rslt != QBMAN_MC_RSLT_OK) {
     346                 :          0 :                 pr_err("Query NP fields of FQID 0x%x failed, code=0x%02x\n",
     347                 :            :                        fqid, r->rslt);
     348                 :          0 :                 return -EIO;
     349                 :            :         }
     350                 :            : 
     351                 :            :         return 0;
     352                 :            : }
     353                 :            : 
     354                 :          0 : uint8_t qbman_fq_state_schedstate(const struct qbman_fq_query_np_rslt *r)
     355                 :            : {
     356                 :          0 :         return r->st1 & 0x7;
     357                 :            : }
     358                 :            : 
     359                 :          0 : int qbman_fq_state_force_eligible(const struct qbman_fq_query_np_rslt *r)
     360                 :            : {
     361                 :          0 :         return (int)((r->st1 & 0x8) >> 3);
     362                 :            : }
     363                 :            : 
     364                 :          0 : int qbman_fq_state_xoff(const struct qbman_fq_query_np_rslt *r)
     365                 :            : {
     366                 :          0 :         return (int)((r->st1 & 0x10) >> 4);
     367                 :            : }
     368                 :            : 
     369                 :          0 : int qbman_fq_state_retirement_pending(const struct qbman_fq_query_np_rslt *r)
     370                 :            : {
     371                 :          0 :         return (int)((r->st1 & 0x20) >> 5);
     372                 :            : }
     373                 :            : 
     374                 :          0 : int qbman_fq_state_overflow_error(const struct qbman_fq_query_np_rslt *r)
     375                 :            : {
     376                 :          0 :         return (int)((r->st1 & 0x40) >> 6);
     377                 :            : }
     378                 :            : 
     379                 :          0 : uint32_t qbman_fq_state_frame_count(const struct qbman_fq_query_np_rslt *r)
     380                 :            : {
     381                 :          0 :         return (r->frm_cnt & 0x00FFFFFF);
     382                 :            : }
     383                 :            : 
     384                 :          0 : uint32_t qbman_fq_state_byte_count(const struct qbman_fq_query_np_rslt *r)
     385                 :            : {
     386                 :          0 :         return r->byte_cnt;
     387                 :            : }
     388                 :            : 
     389                 :            : /* Query CGR */
     390                 :            : struct qbman_cgr_query_desc {
     391                 :            :         uint8_t verb;
     392                 :            :         uint8_t reserved;
     393                 :            :         uint16_t cgid;
     394                 :            :         uint8_t reserved2[60];
     395                 :            : };
     396                 :            : 
     397                 :          0 : int qbman_cgr_query(struct qbman_swp *s, uint32_t cgid,
     398                 :            :                     struct qbman_cgr_query_rslt *r)
     399                 :            : {
     400                 :            :         struct qbman_cgr_query_desc *p;
     401                 :            : 
     402                 :          0 :         p = (struct qbman_cgr_query_desc *)qbman_swp_mc_start(s);
     403         [ #  # ]:          0 :         if (!p)
     404                 :            :                 return -EBUSY;
     405                 :            : 
     406                 :          0 :         p->cgid = cgid;
     407                 :          0 :         *r = *(struct qbman_cgr_query_rslt *)qbman_swp_mc_complete(s, p,
     408                 :            :                                                         QBMAN_CGR_QUERY);
     409                 :            :         if (!r) {
     410                 :            :                 pr_err("qbman: Query CGID %d failed, no response\n",
     411                 :            :                         cgid);
     412                 :            :                 return -EIO;
     413                 :            :         }
     414                 :            : 
     415                 :            :         /* Decode the outcome */
     416                 :            :         QBMAN_BUG_ON((r->verb & QBMAN_RESPONSE_VERB_MASK) != QBMAN_CGR_QUERY);
     417                 :            : 
     418                 :            :         /* Determine success or failure */
     419         [ #  # ]:          0 :         if (r->rslt != QBMAN_MC_RSLT_OK) {
     420                 :          0 :                 pr_err("Query CGID 0x%x failed,code=0x%02x\n", cgid, r->rslt);
     421                 :          0 :                 return -EIO;
     422                 :            :         }
     423                 :            : 
     424                 :            :         return 0;
     425                 :            : }
     426                 :            : 
     427                 :          0 : int qbman_cgr_get_cscn_wq_en_enter(struct qbman_cgr_query_rslt *r)
     428                 :            : {
     429                 :          0 :         return (int)(r->ctl1 & 0x1);
     430                 :            : }
     431                 :            : 
     432                 :          0 : int qbman_cgr_get_cscn_wq_en_exit(struct qbman_cgr_query_rslt *r)
     433                 :            : {
     434                 :          0 :         return (int)((r->ctl1 & 0x2) >> 1);
     435                 :            : }
     436                 :            : 
     437                 :          0 : int qbman_cgr_get_cscn_wq_icd(struct qbman_cgr_query_rslt *r)
     438                 :            : {
     439                 :          0 :         return (int)((r->ctl1 & 0x4) >> 2);
     440                 :            : }
     441                 :            : 
     442                 :          0 : uint8_t qbman_cgr_get_mode(struct qbman_cgr_query_rslt *r)
     443                 :            : {
     444                 :          0 :         return r->mode & 0x3;
     445                 :            : }
     446                 :            : 
     447                 :          0 : int qbman_cgr_get_rej_cnt_mode(struct qbman_cgr_query_rslt *r)
     448                 :            : {
     449                 :          0 :         return (int)((r->mode & 0x4) >> 2);
     450                 :            : }
     451                 :            : 
     452                 :          0 : int qbman_cgr_get_cscn_bdi(struct qbman_cgr_query_rslt *r)
     453                 :            : {
     454                 :          0 :         return (int)((r->mode & 0x8) >> 3);
     455                 :            : }
     456                 :            : 
     457                 :          0 : uint16_t qbman_cgr_attr_get_cs_thres(struct qbman_cgr_query_rslt *r)
     458                 :            : {
     459                 :          0 :         return qbman_thresh_to_value(r->cs_thres);
     460                 :            : }
     461                 :            : 
     462                 :          0 : uint16_t qbman_cgr_attr_get_cs_thres_x(struct qbman_cgr_query_rslt *r)
     463                 :            : {
     464                 :          0 :         return qbman_thresh_to_value(r->cs_thres_x);
     465                 :            : }
     466                 :            : 
     467                 :          0 : uint16_t qbman_cgr_attr_get_td_thres(struct qbman_cgr_query_rslt *r)
     468                 :            : {
     469                 :          0 :         return qbman_thresh_to_value(r->td_thres);
     470                 :            : }
     471                 :            : 
     472                 :          0 : int qbman_cgr_wred_query(struct qbman_swp *s, uint32_t cgid,
     473                 :            :                         struct qbman_wred_query_rslt *r)
     474                 :            : {
     475                 :            :         struct qbman_cgr_query_desc *p;
     476                 :            : 
     477                 :          0 :         p = (struct qbman_cgr_query_desc *)qbman_swp_mc_start(s);
     478         [ #  # ]:          0 :         if (!p)
     479                 :            :                 return -EBUSY;
     480                 :            : 
     481                 :          0 :         p->cgid = cgid;
     482                 :          0 :         *r = *(struct qbman_wred_query_rslt *)qbman_swp_mc_complete(s, p,
     483                 :            :                                                         QBMAN_WRED_QUERY);
     484                 :            :         if (!r) {
     485                 :            :                 pr_err("qbman: Query CGID WRED %d failed, no response\n",
     486                 :            :                         cgid);
     487                 :            :                 return -EIO;
     488                 :            :         }
     489                 :            : 
     490                 :            :         /* Decode the outcome */
     491                 :            :         QBMAN_BUG_ON((r->verb & QBMAN_RESPONSE_VERB_MASK) != QBMAN_WRED_QUERY);
     492                 :            : 
     493                 :            :         /* Determine success or failure */
     494         [ #  # ]:          0 :         if (r->rslt != QBMAN_MC_RSLT_OK) {
     495                 :          0 :                 pr_err("Query CGID WRED 0x%x failed,code=0x%02x\n",
     496                 :            :                                                          cgid, r->rslt);
     497                 :          0 :                 return -EIO;
     498                 :            :         }
     499                 :            : 
     500                 :            :         return 0;
     501                 :            : }
     502                 :            : 
     503                 :          0 : int qbman_cgr_attr_wred_get_edp(struct qbman_wred_query_rslt *r, uint32_t idx)
     504                 :            : {
     505                 :          0 :         return (int)(r->edp[idx] & 1);
     506                 :            : }
     507                 :            : 
     508                 :          0 : uint32_t qbman_cgr_attr_wred_get_parm_dp(struct qbman_wred_query_rslt *r,
     509                 :            :                                          uint32_t idx)
     510                 :            : {
     511                 :          0 :         return r->wred_parm_dp[idx];
     512                 :            : }
     513                 :            : 
     514                 :          0 : void qbman_cgr_attr_wred_dp_decompose(uint32_t dp, uint64_t *minth,
     515                 :            :                                       uint64_t *maxth, uint8_t *maxp)
     516                 :            : {
     517                 :            :         uint8_t ma, mn, step_i, step_s, pn;
     518                 :            : 
     519                 :          0 :         ma = (uint8_t)(dp >> 24);
     520                 :          0 :         mn = (uint8_t)(dp >> 19) & 0x1f;
     521                 :          0 :         step_i = (uint8_t)(dp >> 11);
     522                 :          0 :         step_s = (uint8_t)(dp >> 6) & 0x1f;
     523                 :          0 :         pn = (uint8_t)dp & 0x3f;
     524                 :            : 
     525                 :          0 :         *maxp = (uint8_t)(((pn<<2) * 100)/256);
     526                 :            : 
     527         [ #  # ]:          0 :         if (mn == 0)
     528                 :          0 :                 *maxth = ma;
     529                 :            :         else
     530                 :          0 :                 *maxth = ((ma+256) * (1<<(mn-1)));
     531                 :            : 
     532         [ #  # ]:          0 :         if (step_s == 0)
     533                 :          0 :                 *minth = *maxth - step_i;
     534                 :            :         else
     535                 :          0 :                 *minth = *maxth - (256 + step_i) * (1<<(step_s - 1));
     536                 :          0 : }
     537                 :            : 
     538                 :            : /* Query CGR/CCGR/CQ statistics */
     539                 :            : struct qbman_cgr_statistics_query_desc {
     540                 :            :         uint8_t verb;
     541                 :            :         uint8_t reserved;
     542                 :            :         uint16_t cgid;
     543                 :            :         uint8_t reserved1;
     544                 :            :         uint8_t ct;
     545                 :            :         uint8_t reserved2[58];
     546                 :            : };
     547                 :            : 
     548                 :            : struct qbman_cgr_statistics_query_rslt {
     549                 :            :         uint8_t verb;
     550                 :            :         uint8_t rslt;
     551                 :            :         uint8_t reserved[14];
     552                 :            :         uint64_t frm_cnt;
     553                 :            :         uint64_t byte_cnt;
     554                 :            :         uint32_t reserved2[8];
     555                 :            : };
     556                 :            : 
     557                 :          0 : static int qbman_cgr_statistics_query(struct qbman_swp *s, uint32_t cgid,
     558                 :            :                                       int clear, uint32_t command_type,
     559                 :            :                                       uint64_t *frame_cnt, uint64_t *byte_cnt)
     560                 :            : {
     561                 :            :         struct qbman_cgr_statistics_query_desc *p;
     562                 :            :         struct qbman_cgr_statistics_query_rslt *r;
     563                 :            :         uint32_t query_verb;
     564                 :            : 
     565                 :          0 :         p = (struct qbman_cgr_statistics_query_desc *)qbman_swp_mc_start(s);
     566         [ #  # ]:          0 :         if (!p)
     567                 :            :                 return -EBUSY;
     568                 :            : 
     569                 :          0 :         p->cgid = cgid;
     570         [ #  # ]:          0 :         if (command_type < 2)
     571                 :          0 :                 p->ct = command_type;
     572                 :            :         query_verb = clear ?
     573         [ #  # ]:          0 :                         QBMAN_CGR_STAT_QUERY_CLR : QBMAN_CGR_STAT_QUERY;
     574                 :          0 :         r = (struct qbman_cgr_statistics_query_rslt *)qbman_swp_mc_complete(s,
     575                 :            :                                                         p, query_verb);
     576         [ #  # ]:          0 :         if (!r) {
     577                 :          0 :                 pr_err("qbman: Query CGID %d statistics failed, no response\n",
     578                 :            :                         cgid);
     579                 :          0 :                 return -EIO;
     580                 :            :         }
     581                 :            : 
     582                 :            :         /* Decode the outcome */
     583                 :            :         QBMAN_BUG_ON((r->verb & QBMAN_RESPONSE_VERB_MASK) != query_verb);
     584                 :            : 
     585                 :            :         /* Determine success or failure */
     586         [ #  # ]:          0 :         if (r->rslt != QBMAN_MC_RSLT_OK) {
     587                 :          0 :                 pr_err("Query statistics of CGID 0x%x failed, code=0x%02x\n",
     588                 :            :                                                 cgid, r->rslt);
     589                 :          0 :                 return -EIO;
     590                 :            :         }
     591                 :            : 
     592         [ #  # ]:          0 :         if (*frame_cnt)
     593                 :          0 :                 *frame_cnt = r->frm_cnt & 0xFFFFFFFFFFllu;
     594         [ #  # ]:          0 :         if (*byte_cnt)
     595                 :          0 :                 *byte_cnt = r->byte_cnt & 0xFFFFFFFFFFllu;
     596                 :            : 
     597                 :            :         return 0;
     598                 :            : }
     599                 :            : 
     600                 :          0 : int qbman_cgr_reject_statistics(struct qbman_swp *s, uint32_t cgid, int clear,
     601                 :            :                                 uint64_t *frame_cnt, uint64_t *byte_cnt)
     602                 :            : {
     603                 :          0 :         return qbman_cgr_statistics_query(s, cgid, clear, 0xff,
     604                 :            :                                           frame_cnt, byte_cnt);
     605                 :            : }
     606                 :            : 
     607                 :          0 : int qbman_ccgr_reject_statistics(struct qbman_swp *s, uint32_t cgid, int clear,
     608                 :            :                                  uint64_t *frame_cnt, uint64_t *byte_cnt)
     609                 :            : {
     610                 :          0 :         return qbman_cgr_statistics_query(s, cgid, clear, 1,
     611                 :            :                                           frame_cnt, byte_cnt);
     612                 :            : }
     613                 :            : 
     614                 :          0 : int qbman_cq_dequeue_statistics(struct qbman_swp *s, uint32_t cgid, int clear,
     615                 :            :                                 uint64_t *frame_cnt, uint64_t *byte_cnt)
     616                 :            : {
     617                 :          0 :         return qbman_cgr_statistics_query(s, cgid, clear, 0,
     618                 :            :                                           frame_cnt, byte_cnt);
     619                 :            : }
     620                 :            : 
     621                 :            : /* WQ Chan Query */
     622                 :            : struct qbman_wqchan_query_desc {
     623                 :            :         uint8_t verb;
     624                 :            :         uint8_t reserved;
     625                 :            :         uint16_t chid;
     626                 :            :         uint8_t reserved2[60];
     627                 :            : };
     628                 :            : 
     629                 :          0 : int qbman_wqchan_query(struct qbman_swp *s, uint16_t chanid,
     630                 :            :                        struct qbman_wqchan_query_rslt *r)
     631                 :            : {
     632                 :            :         struct qbman_wqchan_query_desc *p;
     633                 :            : 
     634                 :            :         /* Start the management command */
     635                 :          0 :         p = (struct qbman_wqchan_query_desc *)qbman_swp_mc_start(s);
     636         [ #  # ]:          0 :         if (!p)
     637                 :            :                 return -EBUSY;
     638                 :            : 
     639                 :            :         /* Encode the caller-provided attributes */
     640                 :          0 :         p->chid = chanid;
     641                 :            : 
     642                 :            :         /* Complete the management command */
     643                 :          0 :         *r = *(struct qbman_wqchan_query_rslt *)qbman_swp_mc_complete(s, p,
     644                 :            :                                                         QBMAN_WQ_QUERY);
     645                 :            :         if (!r) {
     646                 :            :                 pr_err("qbman: Query WQ Channel %d failed, no response\n",
     647                 :            :                         chanid);
     648                 :            :                 return -EIO;
     649                 :            :         }
     650                 :            : 
     651                 :            :         /* Decode the outcome */
     652                 :            :         QBMAN_BUG_ON((r->verb & QBMAN_RESPONSE_VERB_MASK) != QBMAN_WQ_QUERY);
     653                 :            : 
     654                 :            :         /* Determine success or failure */
     655         [ #  # ]:          0 :         if (r->rslt != QBMAN_MC_RSLT_OK) {
     656                 :          0 :                 pr_err("Query of WQCHAN 0x%x failed, code=0x%02x\n",
     657                 :            :                        chanid, r->rslt);
     658                 :          0 :                 return -EIO;
     659                 :            :         }
     660                 :            : 
     661                 :            :         return 0;
     662                 :            : }
     663                 :            : 
     664                 :          0 : uint32_t qbman_wqchan_attr_get_wqlen(struct qbman_wqchan_query_rslt *r, int wq)
     665                 :            : {
     666                 :          0 :         return r->wq_len[wq] & 0x00FFFFFF;
     667                 :            : }
     668                 :            : 
     669                 :          0 : uint64_t qbman_wqchan_attr_get_cdan_ctx(struct qbman_wqchan_query_rslt *r)
     670                 :            : {
     671                 :          0 :         return r->cdan_ctx;
     672                 :            : }
     673                 :            : 
     674                 :          0 : uint16_t qbman_wqchan_attr_get_cdan_wqid(struct qbman_wqchan_query_rslt *r)
     675                 :            : {
     676                 :          0 :         return r->cdan_wqid;
     677                 :            : }
     678                 :            : 
     679                 :          0 : uint8_t qbman_wqchan_attr_get_ctrl(struct qbman_wqchan_query_rslt *r)
     680                 :            : {
     681                 :          0 :         return r->ctrl;
     682                 :            : }
     683                 :            : 
     684                 :          0 : uint16_t qbman_wqchan_attr_get_chanid(struct qbman_wqchan_query_rslt *r)
     685                 :            : {
     686                 :          0 :         return r->chid;
     687                 :            : }

Generated by: LCOV version 1.14