drivers/net/bnx2x/bnx2x_stats.c

   1 /*-
   2  * Copyright (c) 2007-2013 QLogic Corporation. All rights reserved.
   3  *
   4  * Eric Davis        <edavis@broadcom.com>
   5  * David Christensen <davidch@broadcom.com>
   6  * Gary Zambrano     <zambrano@broadcom.com>
   7  *
   8  * Copyright (c) 2013-2015 Brocade Communications Systems, Inc.
   9  * Copyright (c) 2015 QLogic Corporation.
  10  * All rights reserved.
  11  * www.qlogic.com
  12  *
  13  * See LICENSE.bnx2x_pmd for copyright and licensing details.
  14  */
  15
  16 #include "bnx2x.h"
  17 #include "bnx2x_stats.h"
  18
  19 #ifdef __i386__
  20 #define BITS_PER_LONG 32
  21 #else
  22 #define BITS_PER_LONG 64
  23 #endif
  24
  25 static inline uint16_t
  26 bnx2x_get_port_stats_dma_len(struct bnx2x_softc *sc)
  27 {
  28         uint16_t res = 0;
  29         uint32_t size;
  30
  31         /* 'newest' convention - shmem2 contains the size of the port stats */
  32         if (SHMEM2_HAS(sc, sizeof_port_stats)) {
  33                 size = SHMEM2_RD(sc, sizeof_port_stats);
  34                 if (size) {
  35                         res = size;
  36                 }
  37
  38                 /* prevent newer BC from causing buffer overflow */
  39                 if (res > sizeof(struct host_port_stats)) {
  40                         res = sizeof(struct host_port_stats);
  41                 }
  42         }
  43
  44         /*
  45          * Older convention - all BCs support the port stats fields up until
  46          * the 'not_used' field
  47          */
  48         if (!res) {
  49                 res = (offsetof(struct host_port_stats, not_used) + 4);
  50
  51                 /* if PFC stats are supported by the MFW, DMA them as well */
  52                 if (sc->devinfo.bc_ver >= REQ_BC_VER_4_PFC_STATS_SUPPORTED) {
  53                         res += (offsetof(struct host_port_stats, pfc_frames_rx_lo) -
  54                                 offsetof(struct host_port_stats, pfc_frames_tx_hi) + 4);
  55                 }
  56         }
  57
  58         res >>= 2;
  59
  60         return res;
  61 }
  62
  63 /*
  64  * Init service functions
  65  */
  66
  67 /*
  68  * Post the next statistics ramrod. Protect it with the lock in
  69  * order to ensure the strict order between statistics ramrods
  70  * (each ramrod has a sequence number passed in a
  71  * sc->fw_stats_req->hdr.drv_stats_counter and ramrods must be
  72  * sent in order).
  73  */
  74 static void
  75 bnx2x_storm_stats_post(struct bnx2x_softc *sc)
  76 {
  77         int rc;
  78
  79         if (!sc->stats_pending) {
  80                 if (sc->stats_pending) {
  81                         return;
  82                 }
  83
  84                 sc->fw_stats_req->hdr.drv_stats_counter =
  85                         htole16(sc->stats_counter++);
  86
  87                 PMD_DEBUG_PERIODIC_LOG(DEBUG, sc,
  88                                 "sending statistics ramrod %d",
  89                                 le16toh(sc->fw_stats_req->hdr.drv_stats_counter));
  90
  91                 /* adjust the ramrod to include VF queues statistics */
  92
  93                 /* send FW stats ramrod */
  94                 rc = bnx2x_sp_post(sc, RAMROD_CMD_ID_COMMON_STAT_QUERY, 0,
  95                                 U64_HI(sc->fw_stats_req_mapping),
  96                                 U64_LO(sc->fw_stats_req_mapping),
  97                                 NONE_CONNECTION_TYPE);
  98                 if (rc == 0) {
  99                         sc->stats_pending = 1;
 100                 }
 101         }
 102 }
 103
 104 static void
 105 bnx2x_hw_stats_post(struct bnx2x_softc *sc)
 106 {
 107         struct dmae_command *dmae = &sc->stats_dmae;
 108         uint32_t *stats_comp = BNX2X_SP(sc, stats_comp);
 109         int loader_idx;
 110         uint32_t opcode;
 111
 112         *stats_comp = DMAE_COMP_VAL;
 113         if (CHIP_REV_IS_SLOW(sc)) {
 114                 return;
 115         }
 116
 117         /* Update MCP's statistics if possible */
 118         if (sc->func_stx) {
 119                 rte_memcpy(BNX2X_SP(sc, func_stats), &sc->func_stats,
 120                                 sizeof(sc->func_stats));
 121         }
 122
 123         /* loader */
 124         if (sc->executer_idx) {
 125                 loader_idx = PMF_DMAE_C(sc);
 126                 opcode =  bnx2x_dmae_opcode(sc, DMAE_SRC_PCI, DMAE_DST_GRC,
 127                                 TRUE, DMAE_COMP_GRC);
 128                 opcode = bnx2x_dmae_opcode_clr_src_reset(opcode);
 129
 130                 memset(dmae, 0, sizeof(struct dmae_command));
 131                 dmae->opcode = opcode;
 132                 dmae->src_addr_lo = U64_LO(BNX2X_SP_MAPPING(sc, dmae[0]));
 133                 dmae->src_addr_hi = U64_HI(BNX2X_SP_MAPPING(sc, dmae[0]));
 134                 dmae->dst_addr_lo = ((DMAE_REG_CMD_MEM +
 135                                         sizeof(struct dmae_command) *
 136                                         (loader_idx + 1)) >> 2);
 137                 dmae->dst_addr_hi = 0;
 138                 dmae->len = sizeof(struct dmae_command) >> 2;
 139                 dmae->comp_addr_lo = (dmae_reg_go_c[loader_idx + 1] >> 2);
 140                 dmae->comp_addr_hi = 0;
 141                 dmae->comp_val = 1;
 142
 143                 *stats_comp = 0;
 144                 bnx2x_post_dmae(sc, dmae, loader_idx);
 145         } else if (sc->func_stx) {
 146                 *stats_comp = 0;
 147                 bnx2x_post_dmae(sc, dmae, INIT_DMAE_C(sc));
 148         }
 149 }
 150
 151 static int
 152 bnx2x_stats_comp(struct bnx2x_softc *sc)
 153 {
 154         uint32_t *stats_comp = BNX2X_SP(sc, stats_comp);
 155         int cnt = 10;
 156
 157         while (*stats_comp != DMAE_COMP_VAL) {
 158                 if (!cnt) {
 159                         PMD_DRV_LOG(ERR, sc, "Timeout waiting for stats finished");
 160                         break;
 161                 }
 162
 163                 cnt--;
 164                 DELAY(1000);
 165         }
 166
 167         return 1;
 168 }
 169
 170 /*
 171  * Statistics service functions
 172  */
 173
 174 static void
 175 bnx2x_stats_pmf_update(struct bnx2x_softc *sc)
 176 {
 177         struct dmae_command *dmae;
 178         uint32_t opcode;
 179         int loader_idx = PMF_DMAE_C(sc);
 180         uint32_t *stats_comp = BNX2X_SP(sc, stats_comp);
 181
 182         if (sc->devinfo.bc_ver <= 0x06001400) {
 183                 /*
 184                  * Bootcode v6.0.21 fixed a GRC timeout that occurs when accessing
 185                  * BRB registers while the BRB block is in reset. The DMA transfer
 186                  * below triggers this issue resulting in the DMAE to stop
 187                  * functioning. Skip this initial stats transfer for old bootcode
 188                  * versions <= 6.0.20.
 189                  */
 190                 return;
 191         }
 192         /* sanity */
 193         if (!sc->port.pmf || !sc->port.port_stx) {
 194                 PMD_DRV_LOG(ERR, sc, "BUG!");
 195                 return;
 196         }
 197
 198         sc->executer_idx = 0;
 199
 200         opcode = bnx2x_dmae_opcode(sc, DMAE_SRC_GRC, DMAE_DST_PCI, FALSE, 0);
 201
 202         dmae = BNX2X_SP(sc, dmae[sc->executer_idx++]);
 203         dmae->opcode = bnx2x_dmae_opcode_add_comp(opcode, DMAE_COMP_GRC);
 204         dmae->src_addr_lo = (sc->port.port_stx >> 2);
 205         dmae->src_addr_hi = 0;
 206         dmae->dst_addr_lo = U64_LO(BNX2X_SP_MAPPING(sc, port_stats));
 207         dmae->dst_addr_hi = U64_HI(BNX2X_SP_MAPPING(sc, port_stats));
 208         dmae->len = DMAE_LEN32_RD_MAX;
 209         dmae->comp_addr_lo = (dmae_reg_go_c[loader_idx] >> 2);
 210         dmae->comp_addr_hi = 0;
 211         dmae->comp_val = 1;
 212
 213         dmae = BNX2X_SP(sc, dmae[sc->executer_idx++]);
 214         dmae->opcode = bnx2x_dmae_opcode_add_comp(opcode, DMAE_COMP_PCI);
 215         dmae->src_addr_lo = ((sc->port.port_stx >> 2) + DMAE_LEN32_RD_MAX);
 216         dmae->src_addr_hi = 0;
 217         dmae->dst_addr_lo = U64_LO(BNX2X_SP_MAPPING(sc, port_stats) +
 218                         DMAE_LEN32_RD_MAX * 4);
 219         dmae->dst_addr_hi = U64_HI(BNX2X_SP_MAPPING(sc, port_stats) +
 220                         DMAE_LEN32_RD_MAX * 4);
 221         dmae->len = (bnx2x_get_port_stats_dma_len(sc) - DMAE_LEN32_RD_MAX);
 222
 223         dmae->comp_addr_lo = U64_LO(BNX2X_SP_MAPPING(sc, stats_comp));
 224         dmae->comp_addr_hi = U64_HI(BNX2X_SP_MAPPING(sc, stats_comp));
 225         dmae->comp_val = DMAE_COMP_VAL;
 226
 227         *stats_comp = 0;
 228         bnx2x_hw_stats_post(sc);
 229         bnx2x_stats_comp(sc);
 230 }
 231
 232 static void
 233 bnx2x_port_stats_init(struct bnx2x_softc *sc)
 234 {
 235     struct dmae_command *dmae;
 236     int port = SC_PORT(sc);
 237     uint32_t opcode;
 238     int loader_idx = PMF_DMAE_C(sc);
 239     uint32_t mac_addr;
 240     uint32_t *stats_comp = BNX2X_SP(sc, stats_comp);
 241
 242     /* sanity */
 243     if (!sc->link_vars.link_up || !sc->port.pmf) {
 244         PMD_DRV_LOG(ERR, sc, "BUG!");
 245         return;
 246     }
 247
 248     sc->executer_idx = 0;
 249
 250     /* MCP */
 251     opcode = bnx2x_dmae_opcode(sc, DMAE_SRC_PCI, DMAE_DST_GRC,
 252                              TRUE, DMAE_COMP_GRC);
 253
 254     if (sc->port.port_stx) {
 255         dmae = BNX2X_SP(sc, dmae[sc->executer_idx++]);
 256         dmae->opcode = opcode;
 257         dmae->src_addr_lo = U64_LO(BNX2X_SP_MAPPING(sc, port_stats));
 258         dmae->src_addr_hi = U64_HI(BNX2X_SP_MAPPING(sc, port_stats));
 259         dmae->dst_addr_lo = sc->port.port_stx >> 2;
 260         dmae->dst_addr_hi = 0;
 261         dmae->len = bnx2x_get_port_stats_dma_len(sc);
 262         dmae->comp_addr_lo = dmae_reg_go_c[loader_idx] >> 2;
 263         dmae->comp_addr_hi = 0;
 264         dmae->comp_val = 1;
 265     }
 266
 267     if (sc->func_stx) {
 268         dmae = BNX2X_SP(sc, dmae[sc->executer_idx++]);
 269         dmae->opcode = opcode;
 270         dmae->src_addr_lo = U64_LO(BNX2X_SP_MAPPING(sc, func_stats));
 271         dmae->src_addr_hi = U64_HI(BNX2X_SP_MAPPING(sc, func_stats));
 272         dmae->dst_addr_lo = (sc->func_stx >> 2);
 273         dmae->dst_addr_hi = 0;
 274         dmae->len = (sizeof(struct host_func_stats) >> 2);
 275         dmae->comp_addr_lo = (dmae_reg_go_c[loader_idx] >> 2);
 276         dmae->comp_addr_hi = 0;
 277         dmae->comp_val = 1;
 278     }
 279
 280     /* MAC */
 281     opcode = bnx2x_dmae_opcode(sc, DMAE_SRC_GRC, DMAE_DST_PCI,
 282                              TRUE, DMAE_COMP_GRC);
 283
 284     /* EMAC is special */
 285     if (sc->link_vars.mac_type == ELINK_MAC_TYPE_EMAC) {
 286         mac_addr = (port ? GRCBASE_EMAC1 : GRCBASE_EMAC0);
 287
 288         /* EMAC_REG_EMAC_RX_STAT_AC (EMAC_REG_EMAC_RX_STAT_AC_COUNT)*/
 289         dmae = BNX2X_SP(sc, dmae[sc->executer_idx++]);
 290         dmae->opcode = opcode;
 291         dmae->src_addr_lo = (mac_addr + EMAC_REG_EMAC_RX_STAT_AC) >> 2;
 292         dmae->src_addr_hi = 0;
 293         dmae->dst_addr_lo = U64_LO(BNX2X_SP_MAPPING(sc, mac_stats));
 294         dmae->dst_addr_hi = U64_HI(BNX2X_SP_MAPPING(sc, mac_stats));
 295         dmae->len = EMAC_REG_EMAC_RX_STAT_AC_COUNT;
 296         dmae->comp_addr_lo = (dmae_reg_go_c[loader_idx] >> 2);
 297         dmae->comp_addr_hi = 0;
 298         dmae->comp_val = 1;
 299
 300         /* EMAC_REG_EMAC_RX_STAT_AC_28 */
 301         dmae = BNX2X_SP(sc, dmae[sc->executer_idx++]);
 302         dmae->opcode = opcode;
 303         dmae->src_addr_lo = ((mac_addr + EMAC_REG_EMAC_RX_STAT_AC_28) >> 2);
 304         dmae->src_addr_hi = 0;
 305         dmae->dst_addr_lo = U64_LO(BNX2X_SP_MAPPING(sc, mac_stats) +
 306                                    offsetof(struct emac_stats,
 307                                             rx_stat_falsecarriererrors));
 308         dmae->dst_addr_hi = U64_HI(BNX2X_SP_MAPPING(sc, mac_stats) +
 309                                    offsetof(struct emac_stats,
 310                                             rx_stat_falsecarriererrors));
 311         dmae->len = 1;
 312         dmae->comp_addr_lo = (dmae_reg_go_c[loader_idx] >> 2);
 313         dmae->comp_addr_hi = 0;
 314         dmae->comp_val = 1;
 315
 316         /* EMAC_REG_EMAC_TX_STAT_AC (EMAC_REG_EMAC_TX_STAT_AC_COUNT)*/
 317         dmae = BNX2X_SP(sc, dmae[sc->executer_idx++]);
 318         dmae->opcode = opcode;
 319         dmae->src_addr_lo = ((mac_addr + EMAC_REG_EMAC_TX_STAT_AC) >> 2);
 320         dmae->src_addr_hi = 0;
 321         dmae->dst_addr_lo = U64_LO(BNX2X_SP_MAPPING(sc, mac_stats) +
 322                                    offsetof(struct emac_stats,
 323                                             tx_stat_ifhcoutoctets));
 324         dmae->dst_addr_hi = U64_HI(BNX2X_SP_MAPPING(sc, mac_stats) +
 325                                    offsetof(struct emac_stats,
 326                                             tx_stat_ifhcoutoctets));
 327         dmae->len = EMAC_REG_EMAC_TX_STAT_AC_COUNT;
 328         dmae->comp_addr_lo = (dmae_reg_go_c[loader_idx] >> 2);
 329         dmae->comp_addr_hi = 0;
 330         dmae->comp_val = 1;
 331     } else {
 332         uint32_t tx_src_addr_lo, rx_src_addr_lo;
 333         uint16_t rx_len, tx_len;
 334
 335         /* configure the params according to MAC type */
 336         switch (sc->link_vars.mac_type) {
 337         case ELINK_MAC_TYPE_BMAC:
 338             mac_addr = (port) ? NIG_REG_INGRESS_BMAC1_MEM :
 339                                 NIG_REG_INGRESS_BMAC0_MEM;
 340
 341             /* BIGMAC_REGISTER_TX_STAT_GTPKT ..
 342                BIGMAC_REGISTER_TX_STAT_GTBYT */
 343             if (CHIP_IS_E1x(sc)) {
 344                 tx_src_addr_lo =
 345                     ((mac_addr + BIGMAC_REGISTER_TX_STAT_GTPKT) >> 2);
 346                 tx_len = ((8 + BIGMAC_REGISTER_TX_STAT_GTBYT -
 347                            BIGMAC_REGISTER_TX_STAT_GTPKT) >> 2);
 348                 rx_src_addr_lo =
 349                     ((mac_addr + BIGMAC_REGISTER_RX_STAT_GR64) >> 2);
 350                 rx_len = ((8 + BIGMAC_REGISTER_RX_STAT_GRIPJ -
 351                            BIGMAC_REGISTER_RX_STAT_GR64) >> 2);
 352             } else {
 353                 tx_src_addr_lo =
 354                     ((mac_addr + BIGMAC2_REGISTER_TX_STAT_GTPOK) >> 2);
 355                 tx_len = ((8 + BIGMAC2_REGISTER_TX_STAT_GTBYT -
 356                            BIGMAC2_REGISTER_TX_STAT_GTPOK) >> 2);
 357                 rx_src_addr_lo =
 358                     ((mac_addr + BIGMAC2_REGISTER_RX_STAT_GR64) >> 2);
 359                 rx_len = ((8 + BIGMAC2_REGISTER_RX_STAT_GRIPJ -
 360                            BIGMAC2_REGISTER_RX_STAT_GR64) >> 2);
 361             }
 362
 363             break;
 364
 365         case ELINK_MAC_TYPE_UMAC: /* handled by MSTAT */
 366         case ELINK_MAC_TYPE_XMAC: /* handled by MSTAT */
 367         default:
 368             mac_addr = (port) ? GRCBASE_MSTAT1 : GRCBASE_MSTAT0;
 369             tx_src_addr_lo = ((mac_addr + MSTAT_REG_TX_STAT_GTXPOK_LO) >> 2);
 370             rx_src_addr_lo = ((mac_addr + MSTAT_REG_RX_STAT_GR64_LO) >> 2);
 371             tx_len =
 372                 (sizeof(sc->sp->mac_stats.mstat_stats.stats_tx) >> 2);
 373             rx_len =
 374                 (sizeof(sc->sp->mac_stats.mstat_stats.stats_rx) >> 2);
 375             break;
 376         }
 377
 378         /* TX stats */
 379         dmae = BNX2X_SP(sc, dmae[sc->executer_idx++]);
 380         dmae->opcode = opcode;
 381         dmae->src_addr_lo = tx_src_addr_lo;
 382         dmae->src_addr_hi = 0;
 383         dmae->len = tx_len;
 384         dmae->dst_addr_lo = U64_LO(BNX2X_SP_MAPPING(sc, mac_stats));
 385         dmae->dst_addr_hi = U64_HI(BNX2X_SP_MAPPING(sc, mac_stats));
 386         dmae->comp_addr_lo = dmae_reg_go_c[loader_idx] >> 2;
 387         dmae->comp_addr_hi = 0;
 388         dmae->comp_val = 1;
 389
 390         /* RX stats */
 391         dmae = BNX2X_SP(sc, dmae[sc->executer_idx++]);
 392         dmae->opcode = opcode;
 393         dmae->src_addr_hi = 0;
 394         dmae->src_addr_lo = rx_src_addr_lo;
 395         dmae->dst_addr_lo =
 396             U64_LO(BNX2X_SP_MAPPING(sc, mac_stats) + (tx_len << 2));
 397         dmae->dst_addr_hi =
 398             U64_HI(BNX2X_SP_MAPPING(sc, mac_stats) + (tx_len << 2));
 399         dmae->len = rx_len;
 400         dmae->comp_addr_lo = dmae_reg_go_c[loader_idx] >> 2;
 401         dmae->comp_addr_hi = 0;
 402         dmae->comp_val = 1;
 403     }
 404
 405     /* NIG */
 406     if (!CHIP_IS_E3(sc)) {
 407         dmae = BNX2X_SP(sc, dmae[sc->executer_idx++]);
 408         dmae->opcode = opcode;
 409         dmae->src_addr_lo =
 410             (port ? NIG_REG_STAT1_EGRESS_MAC_PKT0 :
 411                     NIG_REG_STAT0_EGRESS_MAC_PKT0) >> 2;
 412         dmae->src_addr_hi = 0;
 413         dmae->dst_addr_lo = U64_LO(BNX2X_SP_MAPPING(sc, nig_stats) +
 414                                    offsetof(struct nig_stats,
 415                                             egress_mac_pkt0_lo));
 416         dmae->dst_addr_hi = U64_HI(BNX2X_SP_MAPPING(sc, nig_stats) +
 417                                    offsetof(struct nig_stats,
 418                                             egress_mac_pkt0_lo));
 419         dmae->len = ((2 * sizeof(uint32_t)) >> 2);
 420         dmae->comp_addr_lo = (dmae_reg_go_c[loader_idx] >> 2);
 421         dmae->comp_addr_hi = 0;
 422         dmae->comp_val = 1;
 423
 424         dmae = BNX2X_SP(sc, dmae[sc->executer_idx++]);
 425         dmae->opcode = opcode;
 426         dmae->src_addr_lo =
 427             (port ? NIG_REG_STAT1_EGRESS_MAC_PKT1 :
 428                     NIG_REG_STAT0_EGRESS_MAC_PKT1) >> 2;
 429         dmae->src_addr_hi = 0;
 430         dmae->dst_addr_lo = U64_LO(BNX2X_SP_MAPPING(sc, nig_stats) +
 431                                    offsetof(struct nig_stats,
 432                                             egress_mac_pkt1_lo));
 433         dmae->dst_addr_hi = U64_HI(BNX2X_SP_MAPPING(sc, nig_stats) +
 434                                    offsetof(struct nig_stats,
 435                                             egress_mac_pkt1_lo));
 436         dmae->len = ((2 * sizeof(uint32_t)) >> 2);
 437         dmae->comp_addr_lo = (dmae_reg_go_c[loader_idx] >> 2);
 438         dmae->comp_addr_hi = 0;
 439         dmae->comp_val = 1;
 440     }
 441
 442     dmae = BNX2X_SP(sc, dmae[sc->executer_idx++]);
 443     dmae->opcode = bnx2x_dmae_opcode(sc, DMAE_SRC_GRC, DMAE_DST_PCI,
 444                                    TRUE, DMAE_COMP_PCI);
 445     dmae->src_addr_lo =
 446         (port ? NIG_REG_STAT1_BRB_DISCARD :
 447                 NIG_REG_STAT0_BRB_DISCARD) >> 2;
 448     dmae->src_addr_hi = 0;
 449     dmae->dst_addr_lo = U64_LO(BNX2X_SP_MAPPING(sc, nig_stats));
 450     dmae->dst_addr_hi = U64_HI(BNX2X_SP_MAPPING(sc, nig_stats));
 451     dmae->len = (sizeof(struct nig_stats) - 4*sizeof(uint32_t)) >> 2;
 452
 453     dmae->comp_addr_lo = U64_LO(BNX2X_SP_MAPPING(sc, stats_comp));
 454     dmae->comp_addr_hi = U64_HI(BNX2X_SP_MAPPING(sc, stats_comp));
 455     dmae->comp_val = DMAE_COMP_VAL;
 456
 457     *stats_comp = 0;
 458 }
 459
 460 static void
 461 bnx2x_func_stats_init(struct bnx2x_softc *sc)
 462 {
 463     struct dmae_command *dmae = &sc->stats_dmae;
 464     uint32_t *stats_comp = BNX2X_SP(sc, stats_comp);
 465
 466     /* sanity */
 467     if (!sc->func_stx) {
 468         PMD_DRV_LOG(ERR, sc, "BUG!");
 469         return;
 470     }
 471
 472     sc->executer_idx = 0;
 473     memset(dmae, 0, sizeof(struct dmae_command));
 474
 475     dmae->opcode = bnx2x_dmae_opcode(sc, DMAE_SRC_PCI, DMAE_DST_GRC,
 476                                    TRUE, DMAE_COMP_PCI);
 477     dmae->src_addr_lo = U64_LO(BNX2X_SP_MAPPING(sc, func_stats));
 478     dmae->src_addr_hi = U64_HI(BNX2X_SP_MAPPING(sc, func_stats));
 479     dmae->dst_addr_lo = (sc->func_stx >> 2);
 480     dmae->dst_addr_hi = 0;
 481     dmae->len = (sizeof(struct host_func_stats) >> 2);
 482     dmae->comp_addr_lo = U64_LO(BNX2X_SP_MAPPING(sc, stats_comp));
 483     dmae->comp_addr_hi = U64_HI(BNX2X_SP_MAPPING(sc, stats_comp));
 484     dmae->comp_val = DMAE_COMP_VAL;
 485
 486     *stats_comp = 0;
 487 }
 488
 489 static void
 490 bnx2x_stats_start(struct bnx2x_softc *sc)
 491 {
 492     /*
 493      * VFs travel through here as part of the statistics FSM, but no action
 494      * is required
 495      */
 496     if (IS_VF(sc)) {
 497         return;
 498     }
 499
 500     if (sc->port.pmf) {
 501         bnx2x_port_stats_init(sc);
 502     }
 503
 504     else if (sc->func_stx) {
 505         bnx2x_func_stats_init(sc);
 506     }
 507
 508     bnx2x_hw_stats_post(sc);
 509     bnx2x_storm_stats_post(sc);
 510 }
 511
 512 static void
 513 bnx2x_stats_pmf_start(struct bnx2x_softc *sc)
 514 {
 515     bnx2x_stats_comp(sc);
 516     bnx2x_stats_pmf_update(sc);
 517     bnx2x_stats_start(sc);
 518 }
 519
 520 static void
 521 bnx2x_stats_restart(struct bnx2x_softc *sc)
 522 {
 523     /*
 524      * VFs travel through here as part of the statistics FSM, but no action
 525      * is required
 526      */
 527     if (IS_VF(sc)) {
 528         return;
 529     }
 530
 531     bnx2x_stats_comp(sc);
 532     bnx2x_stats_start(sc);
 533 }
 534
 535 static void
 536 bnx2x_bmac_stats_update(struct bnx2x_softc *sc)
 537 {
 538     struct host_port_stats *pstats = BNX2X_SP(sc, port_stats);
 539     struct bnx2x_eth_stats *estats = &sc->eth_stats;
 540     struct {
 541         uint32_t lo;
 542         uint32_t hi;
 543     } diff;
 544
 545     if (CHIP_IS_E1x(sc)) {
 546         struct bmac1_stats *new = BNX2X_SP(sc, mac_stats.bmac1_stats);
 547
 548         /* the macros below will use "bmac1_stats" type */
 549         UPDATE_STAT64(rx_stat_grerb, rx_stat_ifhcinbadoctets);
 550         UPDATE_STAT64(rx_stat_grfcs, rx_stat_dot3statsfcserrors);
 551         UPDATE_STAT64(rx_stat_grund, rx_stat_etherstatsundersizepkts);
 552         UPDATE_STAT64(rx_stat_grovr, rx_stat_dot3statsframestoolong);
 553         UPDATE_STAT64(rx_stat_grfrg, rx_stat_etherstatsfragments);
 554         UPDATE_STAT64(rx_stat_grjbr, rx_stat_etherstatsjabbers);
 555         UPDATE_STAT64(rx_stat_grxcf, rx_stat_maccontrolframesreceived);
 556         UPDATE_STAT64(rx_stat_grxpf, rx_stat_xoffstateentered);
 557         UPDATE_STAT64(rx_stat_grxpf, rx_stat_mac_xpf);
 558
 559         UPDATE_STAT64(tx_stat_gtxpf, tx_stat_outxoffsent);
 560         UPDATE_STAT64(tx_stat_gtxpf, tx_stat_flowcontroldone);
 561         UPDATE_STAT64(tx_stat_gt64, tx_stat_etherstatspkts64octets);
 562         UPDATE_STAT64(tx_stat_gt127,
 563                       tx_stat_etherstatspkts65octetsto127octets);
 564         UPDATE_STAT64(tx_stat_gt255,
 565                       tx_stat_etherstatspkts128octetsto255octets);
 566         UPDATE_STAT64(tx_stat_gt511,
 567                       tx_stat_etherstatspkts256octetsto511octets);
 568         UPDATE_STAT64(tx_stat_gt1023,
 569                       tx_stat_etherstatspkts512octetsto1023octets);
 570         UPDATE_STAT64(tx_stat_gt1518,
 571                       tx_stat_etherstatspkts1024octetsto1522octets);
 572         UPDATE_STAT64(tx_stat_gt2047, tx_stat_mac_2047);
 573         UPDATE_STAT64(tx_stat_gt4095, tx_stat_mac_4095);
 574         UPDATE_STAT64(tx_stat_gt9216, tx_stat_mac_9216);
 575         UPDATE_STAT64(tx_stat_gt16383, tx_stat_mac_16383);
 576         UPDATE_STAT64(tx_stat_gterr,
 577                       tx_stat_dot3statsinternalmactransmiterrors);
 578         UPDATE_STAT64(tx_stat_gtufl, tx_stat_mac_ufl);
 579     } else {
 580         struct bmac2_stats *new = BNX2X_SP(sc, mac_stats.bmac2_stats);
 581         struct bnx2x_fw_port_stats_old *fwstats = &sc->fw_stats_old;
 582
 583         /* the macros below will use "bmac2_stats" type */
 584         UPDATE_STAT64(rx_stat_grerb, rx_stat_ifhcinbadoctets);
 585         UPDATE_STAT64(rx_stat_grfcs, rx_stat_dot3statsfcserrors);
 586         UPDATE_STAT64(rx_stat_grund, rx_stat_etherstatsundersizepkts);
 587         UPDATE_STAT64(rx_stat_grovr, rx_stat_dot3statsframestoolong);
 588         UPDATE_STAT64(rx_stat_grfrg, rx_stat_etherstatsfragments);
 589         UPDATE_STAT64(rx_stat_grjbr, rx_stat_etherstatsjabbers);
 590         UPDATE_STAT64(rx_stat_grxcf, rx_stat_maccontrolframesreceived);
 591         UPDATE_STAT64(rx_stat_grxpf, rx_stat_xoffstateentered);
 592         UPDATE_STAT64(rx_stat_grxpf, rx_stat_mac_xpf);
 593         UPDATE_STAT64(tx_stat_gtxpf, tx_stat_outxoffsent);
 594         UPDATE_STAT64(tx_stat_gtxpf, tx_stat_flowcontroldone);
 595         UPDATE_STAT64(tx_stat_gt64, tx_stat_etherstatspkts64octets);
 596         UPDATE_STAT64(tx_stat_gt127,
 597                       tx_stat_etherstatspkts65octetsto127octets);
 598         UPDATE_STAT64(tx_stat_gt255,
 599                       tx_stat_etherstatspkts128octetsto255octets);
 600         UPDATE_STAT64(tx_stat_gt511,
 601                       tx_stat_etherstatspkts256octetsto511octets);
 602         UPDATE_STAT64(tx_stat_gt1023,
 603                       tx_stat_etherstatspkts512octetsto1023octets);
 604         UPDATE_STAT64(tx_stat_gt1518,
 605                       tx_stat_etherstatspkts1024octetsto1522octets);
 606         UPDATE_STAT64(tx_stat_gt2047, tx_stat_mac_2047);
 607         UPDATE_STAT64(tx_stat_gt4095, tx_stat_mac_4095);
 608         UPDATE_STAT64(tx_stat_gt9216, tx_stat_mac_9216);
 609         UPDATE_STAT64(tx_stat_gt16383, tx_stat_mac_16383);
 610         UPDATE_STAT64(tx_stat_gterr,
 611                       tx_stat_dot3statsinternalmactransmiterrors);
 612         UPDATE_STAT64(tx_stat_gtufl, tx_stat_mac_ufl);
 613
 614         /* collect PFC stats */
 615         pstats->pfc_frames_tx_hi = new->tx_stat_gtpp_hi;
 616         pstats->pfc_frames_tx_lo = new->tx_stat_gtpp_lo;
 617         ADD_64(pstats->pfc_frames_tx_hi, fwstats->pfc_frames_tx_hi,
 618                pstats->pfc_frames_tx_lo, fwstats->pfc_frames_tx_lo);
 619
 620         pstats->pfc_frames_rx_hi = new->rx_stat_grpp_hi;
 621         pstats->pfc_frames_rx_lo = new->rx_stat_grpp_lo;
 622         ADD_64(pstats->pfc_frames_rx_hi, fwstats->pfc_frames_rx_hi,
 623                pstats->pfc_frames_rx_lo, fwstats->pfc_frames_rx_lo);
 624     }
 625
 626     estats->pause_frames_received_hi = pstats->mac_stx[1].rx_stat_mac_xpf_hi;
 627     estats->pause_frames_received_lo = pstats->mac_stx[1].rx_stat_mac_xpf_lo;
 628
 629     estats->pause_frames_sent_hi = pstats->mac_stx[1].tx_stat_outxoffsent_hi;
 630     estats->pause_frames_sent_lo = pstats->mac_stx[1].tx_stat_outxoffsent_lo;
 631
 632     estats->pfc_frames_received_hi = pstats->pfc_frames_rx_hi;
 633     estats->pfc_frames_received_lo = pstats->pfc_frames_rx_lo;
 634     estats->pfc_frames_sent_hi = pstats->pfc_frames_tx_hi;
 635     estats->pfc_frames_sent_lo = pstats->pfc_frames_tx_lo;
 636 }
 637
 638 static void
 639 bnx2x_mstat_stats_update(struct bnx2x_softc *sc)
 640 {
 641     struct host_port_stats *pstats = BNX2X_SP(sc, port_stats);
 642     struct bnx2x_eth_stats *estats = &sc->eth_stats;
 643     struct mstat_stats *new = BNX2X_SP(sc, mac_stats.mstat_stats);
 644
 645     ADD_STAT64(stats_rx.rx_grerb, rx_stat_ifhcinbadoctets);
 646     ADD_STAT64(stats_rx.rx_grfcs, rx_stat_dot3statsfcserrors);
 647     ADD_STAT64(stats_rx.rx_grund, rx_stat_etherstatsundersizepkts);
 648     ADD_STAT64(stats_rx.rx_grovr, rx_stat_dot3statsframestoolong);
 649     ADD_STAT64(stats_rx.rx_grfrg, rx_stat_etherstatsfragments);
 650     ADD_STAT64(stats_rx.rx_grxcf, rx_stat_maccontrolframesreceived);
 651     ADD_STAT64(stats_rx.rx_grxpf, rx_stat_xoffstateentered);
 652     ADD_STAT64(stats_rx.rx_grxpf, rx_stat_mac_xpf);
 653     ADD_STAT64(stats_tx.tx_gtxpf, tx_stat_outxoffsent);
 654     ADD_STAT64(stats_tx.tx_gtxpf, tx_stat_flowcontroldone);
 655
 656     /* collect pfc stats */
 657     ADD_64(pstats->pfc_frames_tx_hi, new->stats_tx.tx_gtxpp_hi,
 658            pstats->pfc_frames_tx_lo, new->stats_tx.tx_gtxpp_lo);
 659     ADD_64(pstats->pfc_frames_rx_hi, new->stats_rx.rx_grxpp_hi,
 660            pstats->pfc_frames_rx_lo, new->stats_rx.rx_grxpp_lo);
 661
 662     ADD_STAT64(stats_tx.tx_gt64, tx_stat_etherstatspkts64octets);
 663     ADD_STAT64(stats_tx.tx_gt127, tx_stat_etherstatspkts65octetsto127octets);
 664     ADD_STAT64(stats_tx.tx_gt255, tx_stat_etherstatspkts128octetsto255octets);
 665     ADD_STAT64(stats_tx.tx_gt511, tx_stat_etherstatspkts256octetsto511octets);
 666     ADD_STAT64(stats_tx.tx_gt1023,
 667                tx_stat_etherstatspkts512octetsto1023octets);
 668     ADD_STAT64(stats_tx.tx_gt1518,
 669                tx_stat_etherstatspkts1024octetsto1522octets);
 670     ADD_STAT64(stats_tx.tx_gt2047, tx_stat_mac_2047);
 671
 672     ADD_STAT64(stats_tx.tx_gt4095, tx_stat_mac_4095);
 673     ADD_STAT64(stats_tx.tx_gt9216, tx_stat_mac_9216);
 674     ADD_STAT64(stats_tx.tx_gt16383, tx_stat_mac_16383);
 675
 676     ADD_STAT64(stats_tx.tx_gterr, tx_stat_dot3statsinternalmactransmiterrors);
 677     ADD_STAT64(stats_tx.tx_gtufl, tx_stat_mac_ufl);
 678
 679     estats->etherstatspkts1024octetsto1522octets_hi =
 680         pstats->mac_stx[1].tx_stat_etherstatspkts1024octetsto1522octets_hi;
 681     estats->etherstatspkts1024octetsto1522octets_lo =
 682         pstats->mac_stx[1].tx_stat_etherstatspkts1024octetsto1522octets_lo;
 683
 684     estats->etherstatspktsover1522octets_hi =
 685         pstats->mac_stx[1].tx_stat_mac_2047_hi;
 686     estats->etherstatspktsover1522octets_lo =
 687         pstats->mac_stx[1].tx_stat_mac_2047_lo;
 688
 689     ADD_64(estats->etherstatspktsover1522octets_hi,
 690            pstats->mac_stx[1].tx_stat_mac_4095_hi,
 691            estats->etherstatspktsover1522octets_lo,
 692            pstats->mac_stx[1].tx_stat_mac_4095_lo);
 693
 694     ADD_64(estats->etherstatspktsover1522octets_hi,
 695            pstats->mac_stx[1].tx_stat_mac_9216_hi,
 696            estats->etherstatspktsover1522octets_lo,
 697            pstats->mac_stx[1].tx_stat_mac_9216_lo);
 698
 699     ADD_64(estats->etherstatspktsover1522octets_hi,
 700            pstats->mac_stx[1].tx_stat_mac_16383_hi,
 701            estats->etherstatspktsover1522octets_lo,
 702            pstats->mac_stx[1].tx_stat_mac_16383_lo);
 703
 704     estats->pause_frames_received_hi = pstats->mac_stx[1].rx_stat_mac_xpf_hi;
 705     estats->pause_frames_received_lo = pstats->mac_stx[1].rx_stat_mac_xpf_lo;
 706
 707     estats->pause_frames_sent_hi = pstats->mac_stx[1].tx_stat_outxoffsent_hi;
 708     estats->pause_frames_sent_lo = pstats->mac_stx[1].tx_stat_outxoffsent_lo;
 709
 710     estats->pfc_frames_received_hi = pstats->pfc_frames_rx_hi;
 711     estats->pfc_frames_received_lo = pstats->pfc_frames_rx_lo;
 712     estats->pfc_frames_sent_hi = pstats->pfc_frames_tx_hi;
 713     estats->pfc_frames_sent_lo = pstats->pfc_frames_tx_lo;
 714 }
 715
 716 static void
 717 bnx2x_emac_stats_update(struct bnx2x_softc *sc)
 718 {
 719     struct emac_stats *new = BNX2X_SP(sc, mac_stats.emac_stats);
 720     struct host_port_stats *pstats = BNX2X_SP(sc, port_stats);
 721     struct bnx2x_eth_stats *estats = &sc->eth_stats;
 722
 723     UPDATE_EXTEND_STAT(rx_stat_ifhcinbadoctets);
 724     UPDATE_EXTEND_STAT(tx_stat_ifhcoutbadoctets);
 725     UPDATE_EXTEND_STAT(rx_stat_dot3statsfcserrors);
 726     UPDATE_EXTEND_STAT(rx_stat_dot3statsalignmenterrors);
 727     UPDATE_EXTEND_STAT(rx_stat_dot3statscarriersenseerrors);
 728     UPDATE_EXTEND_STAT(rx_stat_falsecarriererrors);
 729     UPDATE_EXTEND_STAT(rx_stat_etherstatsundersizepkts);
 730     UPDATE_EXTEND_STAT(rx_stat_dot3statsframestoolong);
 731     UPDATE_EXTEND_STAT(rx_stat_etherstatsfragments);
 732     UPDATE_EXTEND_STAT(rx_stat_etherstatsjabbers);
 733     UPDATE_EXTEND_STAT(rx_stat_maccontrolframesreceived);
 734     UPDATE_EXTEND_STAT(rx_stat_xoffstateentered);
 735     UPDATE_EXTEND_STAT(rx_stat_xonpauseframesreceived);
 736     UPDATE_EXTEND_STAT(rx_stat_xoffpauseframesreceived);
 737     UPDATE_EXTEND_STAT(tx_stat_outxonsent);
 738     UPDATE_EXTEND_STAT(tx_stat_outxoffsent);
 739     UPDATE_EXTEND_STAT(tx_stat_flowcontroldone);
 740     UPDATE_EXTEND_STAT(tx_stat_etherstatscollisions);
 741     UPDATE_EXTEND_STAT(tx_stat_dot3statssinglecollisionframes);
 742     UPDATE_EXTEND_STAT(tx_stat_dot3statsmultiplecollisionframes);
 743     UPDATE_EXTEND_STAT(tx_stat_dot3statsdeferredtransmissions);
 744     UPDATE_EXTEND_STAT(tx_stat_dot3statsexcessivecollisions);
 745     UPDATE_EXTEND_STAT(tx_stat_dot3statslatecollisions);
 746     UPDATE_EXTEND_STAT(tx_stat_etherstatspkts64octets);
 747     UPDATE_EXTEND_STAT(tx_stat_etherstatspkts65octetsto127octets);
 748     UPDATE_EXTEND_STAT(tx_stat_etherstatspkts128octetsto255octets);
 749     UPDATE_EXTEND_STAT(tx_stat_etherstatspkts256octetsto511octets);
 750     UPDATE_EXTEND_STAT(tx_stat_etherstatspkts512octetsto1023octets);
 751     UPDATE_EXTEND_STAT(tx_stat_etherstatspkts1024octetsto1522octets);
 752     UPDATE_EXTEND_STAT(tx_stat_etherstatspktsover1522octets);
 753     UPDATE_EXTEND_STAT(tx_stat_dot3statsinternalmactransmiterrors);
 754
 755     estats->pause_frames_received_hi =
 756         pstats->mac_stx[1].rx_stat_xonpauseframesreceived_hi;
 757     estats->pause_frames_received_lo =
 758         pstats->mac_stx[1].rx_stat_xonpauseframesreceived_lo;
 759     ADD_64(estats->pause_frames_received_hi,
 760            pstats->mac_stx[1].rx_stat_xoffpauseframesreceived_hi,
 761            estats->pause_frames_received_lo,
 762            pstats->mac_stx[1].rx_stat_xoffpauseframesreceived_lo);
 763
 764     estats->pause_frames_sent_hi =
 765         pstats->mac_stx[1].tx_stat_outxonsent_hi;
 766     estats->pause_frames_sent_lo =
 767         pstats->mac_stx[1].tx_stat_outxonsent_lo;
 768     ADD_64(estats->pause_frames_sent_hi,
 769            pstats->mac_stx[1].tx_stat_outxoffsent_hi,
 770            estats->pause_frames_sent_lo,
 771            pstats->mac_stx[1].tx_stat_outxoffsent_lo);
 772 }
 773
 774 static int
 775 bnx2x_hw_stats_update(struct bnx2x_softc *sc)
 776 {
 777     struct nig_stats *new = BNX2X_SP(sc, nig_stats);
 778     struct nig_stats *old = &(sc->port.old_nig_stats);
 779     struct host_port_stats *pstats = BNX2X_SP(sc, port_stats);
 780     struct bnx2x_eth_stats *estats = &sc->eth_stats;
 781     uint32_t lpi_reg, nig_timer_max;
 782     struct {
 783         uint32_t lo;
 784         uint32_t hi;
 785     } diff;
 786
 787     switch (sc->link_vars.mac_type) {
 788     case ELINK_MAC_TYPE_BMAC:
 789         bnx2x_bmac_stats_update(sc);
 790         break;
 791
 792     case ELINK_MAC_TYPE_EMAC:
 793         bnx2x_emac_stats_update(sc);
 794         break;
 795
 796     case ELINK_MAC_TYPE_UMAC:
 797     case ELINK_MAC_TYPE_XMAC:
 798         bnx2x_mstat_stats_update(sc);
 799         break;
 800
 801     case ELINK_MAC_TYPE_NONE: /* unreached */
 802         PMD_DRV_LOG(DEBUG, sc,
 803               "stats updated by DMAE but no MAC active");
 804         return -1;
 805
 806     default: /* unreached */
 807         PMD_DRV_LOG(ERR, sc, "stats update failed, unknown MAC type");
 808     }
 809
 810     ADD_EXTEND_64(pstats->brb_drop_hi, pstats->brb_drop_lo,
 811                   new->brb_discard - old->brb_discard);
 812     ADD_EXTEND_64(estats->brb_truncate_hi, estats->brb_truncate_lo,
 813                   new->brb_truncate - old->brb_truncate);
 814
 815     if (!CHIP_IS_E3(sc)) {
 816         UPDATE_STAT64_NIG(egress_mac_pkt0,
 817                           etherstatspkts1024octetsto1522octets);
 818         UPDATE_STAT64_NIG(egress_mac_pkt1,
 819                           etherstatspktsover1522octets);
 820     }
 821
 822     rte_memcpy(old, new, sizeof(struct nig_stats));
 823
 824     rte_memcpy(&(estats->rx_stat_ifhcinbadoctets_hi), &(pstats->mac_stx[1]),
 825            sizeof(struct mac_stx));
 826     estats->brb_drop_hi = pstats->brb_drop_hi;
 827     estats->brb_drop_lo = pstats->brb_drop_lo;
 828
 829     pstats->host_port_stats_counter++;
 830
 831     if (CHIP_IS_E3(sc)) {
 832         lpi_reg = (SC_PORT(sc)) ?
 833                       MISC_REG_CPMU_LP_SM_ENT_CNT_P1 :
 834                       MISC_REG_CPMU_LP_SM_ENT_CNT_P0;
 835         estats->eee_tx_lpi += REG_RD(sc, lpi_reg);
 836     }
 837
 838     if (!BNX2X_NOMCP(sc)) {
 839         nig_timer_max = SHMEM_RD(sc, port_mb[SC_PORT(sc)].stat_nig_timer);
 840         if (nig_timer_max != estats->nig_timer_max) {
 841             estats->nig_timer_max = nig_timer_max;
 842             PMD_DRV_LOG(ERR, sc, "invalid NIG timer max (%u)",
 843                   estats->nig_timer_max);
 844         }
 845     }
 846
 847     return 0;
 848 }
 849
 850 static int
 851 bnx2x_storm_stats_validate_counters(struct bnx2x_softc *sc)
 852 {
 853     struct stats_counter *counters = &sc->fw_stats_data->storm_counters;
 854     uint16_t cur_stats_counter;
 855
 856     /*
 857      * Make sure we use the value of the counter
 858      * used for sending the last stats ramrod.
 859      */
 860     cur_stats_counter = (sc->stats_counter - 1);
 861
 862     /* are storm stats valid? */
 863     if (le16toh(counters->xstats_counter) != cur_stats_counter) {
 864         PMD_DRV_LOG(DEBUG, sc,
 865               "stats not updated by xstorm, "
 866               "counter 0x%x != stats_counter 0x%x",
 867               le16toh(counters->xstats_counter), sc->stats_counter);
 868         return -EAGAIN;
 869     }
 870
 871     if (le16toh(counters->ustats_counter) != cur_stats_counter) {
 872         PMD_DRV_LOG(DEBUG, sc,
 873               "stats not updated by ustorm, "
 874               "counter 0x%x != stats_counter 0x%x",
 875               le16toh(counters->ustats_counter), sc->stats_counter);
 876         return -EAGAIN;
 877     }
 878
 879     if (le16toh(counters->cstats_counter) != cur_stats_counter) {
 880         PMD_DRV_LOG(DEBUG, sc,
 881               "stats not updated by cstorm, "
 882               "counter 0x%x != stats_counter 0x%x",
 883               le16toh(counters->cstats_counter), sc->stats_counter);
 884         return -EAGAIN;
 885     }
 886
 887     if (le16toh(counters->tstats_counter) != cur_stats_counter) {
 888         PMD_DRV_LOG(DEBUG, sc,
 889               "stats not updated by tstorm, "
 890               "counter 0x%x != stats_counter 0x%x",
 891               le16toh(counters->tstats_counter), sc->stats_counter);
 892         return -EAGAIN;
 893     }
 894
 895     return 0;
 896 }
 897
 898 static int
 899 bnx2x_storm_stats_update(struct bnx2x_softc *sc)
 900 {
 901         struct tstorm_per_port_stats *tport =
 902                 &sc->fw_stats_data->port.tstorm_port_statistics;
 903         struct tstorm_per_pf_stats *tfunc =
 904                 &sc->fw_stats_data->pf.tstorm_pf_statistics;
 905         struct host_func_stats *fstats = &sc->func_stats;
 906         struct bnx2x_eth_stats *estats = &sc->eth_stats;
 907         struct bnx2x_eth_stats_old *estats_old = &sc->eth_stats_old;
 908         int i;
 909
 910         /* vfs stat counter is managed by pf */
 911         if (IS_PF(sc) && bnx2x_storm_stats_validate_counters(sc)) {
 912                 return -EAGAIN;
 913         }
 914
 915         estats->error_bytes_received_hi = 0;
 916         estats->error_bytes_received_lo = 0;
 917
 918         for (i = 0; i < sc->num_queues; i++) {
 919                 struct bnx2x_fastpath *fp = &sc->fp[i];
 920                 struct tstorm_per_queue_stats *tclient =
 921                         &sc->fw_stats_data->queue_stats[i].tstorm_queue_statistics;
 922                 struct tstorm_per_queue_stats *old_tclient = &fp->old_tclient;
 923                 struct ustorm_per_queue_stats *uclient =
 924                         &sc->fw_stats_data->queue_stats[i].ustorm_queue_statistics;
 925                 struct ustorm_per_queue_stats *old_uclient = &fp->old_uclient;
 926                 struct xstorm_per_queue_stats *xclient =
 927                         &sc->fw_stats_data->queue_stats[i].xstorm_queue_statistics;
 928                 struct xstorm_per_queue_stats *old_xclient = &fp->old_xclient;
 929                 struct bnx2x_eth_q_stats *qstats = &fp->eth_q_stats;
 930                 struct bnx2x_eth_q_stats_old *qstats_old = &fp->eth_q_stats_old;
 931
 932                 uint32_t diff;
 933
 934                 /* PMD_DRV_LOG(DEBUG, sc,
 935                                 "queue[%d]: ucast_sent 0x%x bcast_sent 0x%x mcast_sent 0x%x",
 936                                 i, xclient->ucast_pkts_sent, xclient->bcast_pkts_sent,
 937                                 xclient->mcast_pkts_sent);
 938
 939                 PMD_DRV_LOG(DEBUG, sc, "---------------");
 940                  */
 941
 942                 UPDATE_QSTAT(tclient->rcv_bcast_bytes,
 943                                 total_broadcast_bytes_received);
 944                 UPDATE_QSTAT(tclient->rcv_mcast_bytes,
 945                                 total_multicast_bytes_received);
 946                 UPDATE_QSTAT(tclient->rcv_ucast_bytes,
 947                                 total_unicast_bytes_received);
 948
 949                 /*
 950                  * sum to total_bytes_received all
 951                  * unicast/multicast/broadcast
 952                  */
 953                 qstats->total_bytes_received_hi =
 954                         qstats->total_broadcast_bytes_received_hi;
 955                 qstats->total_bytes_received_lo =
 956                         qstats->total_broadcast_bytes_received_lo;
 957
 958                 ADD_64(qstats->total_bytes_received_hi,
 959                                 qstats->total_multicast_bytes_received_hi,
 960                                 qstats->total_bytes_received_lo,
 961                                 qstats->total_multicast_bytes_received_lo);
 962
 963                 ADD_64(qstats->total_bytes_received_hi,
 964                                 qstats->total_unicast_bytes_received_hi,
 965                                 qstats->total_bytes_received_lo,
 966                                 qstats->total_unicast_bytes_received_lo);
 967
 968                 qstats->valid_bytes_received_hi = qstats->total_bytes_received_hi;
 969                 qstats->valid_bytes_received_lo = qstats->total_bytes_received_lo;
 970
 971                 UPDATE_EXTEND_TSTAT(rcv_ucast_pkts, total_unicast_packets_received);
 972                 UPDATE_EXTEND_TSTAT(rcv_mcast_pkts, total_multicast_packets_received);
 973                 UPDATE_EXTEND_TSTAT(rcv_bcast_pkts, total_broadcast_packets_received);
 974                 UPDATE_EXTEND_E_TSTAT(pkts_too_big_discard,
 975                                 etherstatsoverrsizepkts, 32);
 976                 UPDATE_EXTEND_E_TSTAT(no_buff_discard, no_buff_discard, 16);
 977
 978                 SUB_EXTEND_USTAT(ucast_no_buff_pkts, total_unicast_packets_received);
 979                 SUB_EXTEND_USTAT(mcast_no_buff_pkts,
 980                                 total_multicast_packets_received);
 981                 SUB_EXTEND_USTAT(bcast_no_buff_pkts,
 982                                 total_broadcast_packets_received);
 983                 UPDATE_EXTEND_E_USTAT(ucast_no_buff_pkts, no_buff_discard);
 984                 UPDATE_EXTEND_E_USTAT(mcast_no_buff_pkts, no_buff_discard);
 985                 UPDATE_EXTEND_E_USTAT(bcast_no_buff_pkts, no_buff_discard);
 986
 987                 UPDATE_QSTAT(xclient->bcast_bytes_sent,
 988                                 total_broadcast_bytes_transmitted);
 989                 UPDATE_QSTAT(xclient->mcast_bytes_sent,
 990                                 total_multicast_bytes_transmitted);
 991                 UPDATE_QSTAT(xclient->ucast_bytes_sent,
 992                                 total_unicast_bytes_transmitted);
 993
 994                 /*
 995                  * sum to total_bytes_transmitted all
 996                  * unicast/multicast/broadcast
 997                  */
 998                 qstats->total_bytes_transmitted_hi =
 999                         qstats->total_unicast_bytes_transmitted_hi;
1000                 qstats->total_bytes_transmitted_lo =
1001                         qstats->total_unicast_bytes_transmitted_lo;
1002
1003                 ADD_64(qstats->total_bytes_transmitted_hi,
1004                                 qstats->total_broadcast_bytes_transmitted_hi,
1005                                 qstats->total_bytes_transmitted_lo,
1006                                 qstats->total_broadcast_bytes_transmitted_lo);
1007
1008                 ADD_64(qstats->total_bytes_transmitted_hi,
1009                                 qstats->total_multicast_bytes_transmitted_hi,
1010                                 qstats->total_bytes_transmitted_lo,
1011                                 qstats->total_multicast_bytes_transmitted_lo);
1012
1013                 UPDATE_EXTEND_XSTAT(ucast_pkts_sent,
1014                                 total_unicast_packets_transmitted);
1015                 UPDATE_EXTEND_XSTAT(mcast_pkts_sent,
1016                                 total_multicast_packets_transmitted);
1017                 UPDATE_EXTEND_XSTAT(bcast_pkts_sent,
1018                                 total_broadcast_packets_transmitted);
1019
1020                 UPDATE_EXTEND_TSTAT(checksum_discard,
1021                                 total_packets_received_checksum_discarded);
1022                 UPDATE_EXTEND_TSTAT(ttl0_discard,
1023                                 total_packets_received_ttl0_discarded);
1024
1025                 UPDATE_EXTEND_XSTAT(error_drop_pkts,
1026                                 total_transmitted_dropped_packets_error);
1027
1028                 UPDATE_FSTAT_QSTAT(total_bytes_received);
1029                 UPDATE_FSTAT_QSTAT(total_bytes_transmitted);
1030                 UPDATE_FSTAT_QSTAT(total_unicast_packets_received);
1031                 UPDATE_FSTAT_QSTAT(total_multicast_packets_received);
1032                 UPDATE_FSTAT_QSTAT(total_broadcast_packets_received);
1033                 UPDATE_FSTAT_QSTAT(total_unicast_packets_transmitted);
1034                 UPDATE_FSTAT_QSTAT(total_multicast_packets_transmitted);
1035                 UPDATE_FSTAT_QSTAT(total_broadcast_packets_transmitted);
1036                 UPDATE_FSTAT_QSTAT(valid_bytes_received);
1037         }
1038
1039         ADD_64(estats->total_bytes_received_hi,
1040                         estats->rx_stat_ifhcinbadoctets_hi,
1041                         estats->total_bytes_received_lo,
1042                         estats->rx_stat_ifhcinbadoctets_lo);
1043
1044         ADD_64_LE(estats->total_bytes_received_hi,
1045                         tfunc->rcv_error_bytes.hi,
1046                         estats->total_bytes_received_lo,
1047                         tfunc->rcv_error_bytes.lo);
1048
1049         ADD_64_LE(estats->error_bytes_received_hi,
1050                         tfunc->rcv_error_bytes.hi,
1051                         estats->error_bytes_received_lo,
1052                         tfunc->rcv_error_bytes.lo);
1053
1054         UPDATE_ESTAT(etherstatsoverrsizepkts, rx_stat_dot3statsframestoolong);
1055
1056         ADD_64(estats->error_bytes_received_hi,
1057                         estats->rx_stat_ifhcinbadoctets_hi,
1058                         estats->error_bytes_received_lo,
1059                         estats->rx_stat_ifhcinbadoctets_lo);
1060
1061         if (sc->port.pmf) {
1062                 struct bnx2x_fw_port_stats_old *fwstats = &sc->fw_stats_old;
1063                 UPDATE_FW_STAT(mac_filter_discard);
1064                 UPDATE_FW_STAT(mf_tag_discard);
1065                 UPDATE_FW_STAT(brb_truncate_discard);
1066                 UPDATE_FW_STAT(mac_discard);
1067         }
1068
1069         fstats->host_func_stats_start = ++fstats->host_func_stats_end;
1070
1071         sc->stats_pending = 0;
1072
1073         return 0;
1074 }
1075
1076 static void
1077 bnx2x_drv_stats_update(struct bnx2x_softc *sc)
1078 {
1079     struct bnx2x_eth_stats *estats = &sc->eth_stats;
1080     int i;
1081
1082     for (i = 0; i < sc->num_queues; i++) {
1083         struct bnx2x_eth_q_stats *qstats = &sc->fp[i].eth_q_stats;
1084         struct bnx2x_eth_q_stats_old *qstats_old = &sc->fp[i].eth_q_stats_old;
1085
1086         UPDATE_ESTAT_QSTAT(rx_calls);
1087         UPDATE_ESTAT_QSTAT(rx_pkts);
1088         UPDATE_ESTAT_QSTAT(rx_soft_errors);
1089         UPDATE_ESTAT_QSTAT(rx_hw_csum_errors);
1090         UPDATE_ESTAT_QSTAT(rx_ofld_frames_csum_ip);
1091         UPDATE_ESTAT_QSTAT(rx_ofld_frames_csum_tcp_udp);
1092         UPDATE_ESTAT_QSTAT(rx_budget_reached);
1093         UPDATE_ESTAT_QSTAT(tx_pkts);
1094         UPDATE_ESTAT_QSTAT(tx_soft_errors);
1095         UPDATE_ESTAT_QSTAT(tx_ofld_frames_csum_ip);
1096         UPDATE_ESTAT_QSTAT(tx_ofld_frames_csum_tcp);
1097         UPDATE_ESTAT_QSTAT(tx_ofld_frames_csum_udp);
1098         UPDATE_ESTAT_QSTAT(tx_encap_failures);
1099         UPDATE_ESTAT_QSTAT(tx_hw_queue_full);
1100         UPDATE_ESTAT_QSTAT(tx_hw_max_queue_depth);
1101         UPDATE_ESTAT_QSTAT(tx_dma_mapping_failure);
1102         UPDATE_ESTAT_QSTAT(tx_max_drbr_queue_depth);
1103         UPDATE_ESTAT_QSTAT(tx_window_violation_std);
1104         UPDATE_ESTAT_QSTAT(tx_chain_lost_mbuf);
1105         UPDATE_ESTAT_QSTAT(tx_frames_deferred);
1106         UPDATE_ESTAT_QSTAT(tx_queue_xoff);
1107
1108         /* mbuf driver statistics */
1109         UPDATE_ESTAT_QSTAT(mbuf_defrag_attempts);
1110         UPDATE_ESTAT_QSTAT(mbuf_defrag_failures);
1111         UPDATE_ESTAT_QSTAT(mbuf_rx_bd_alloc_failed);
1112         UPDATE_ESTAT_QSTAT(mbuf_rx_bd_mapping_failed);
1113
1114         /* track the number of allocated mbufs */
1115         UPDATE_ESTAT_QSTAT(mbuf_alloc_tx);
1116         UPDATE_ESTAT_QSTAT(mbuf_alloc_rx);
1117     }
1118 }
1119
1120 static uint8_t
1121 bnx2x_edebug_stats_stopped(struct bnx2x_softc *sc)
1122 {
1123     uint32_t val;
1124
1125     if (SHMEM2_HAS(sc, edebug_driver_if[1])) {
1126         val = SHMEM2_RD(sc, edebug_driver_if[1]);
1127
1128         if (val == EDEBUG_DRIVER_IF_OP_CODE_DISABLE_STAT) {
1129             return TRUE;
1130         }
1131     }
1132
1133     return FALSE;
1134 }
1135
1136 static void
1137 bnx2x_stats_update(struct bnx2x_softc *sc)
1138 {
1139         uint32_t *stats_comp = BNX2X_SP(sc, stats_comp);
1140
1141         if (bnx2x_edebug_stats_stopped(sc)) {
1142                 return;
1143         }
1144
1145         if (IS_PF(sc)) {
1146
1147                 bnx2x_storm_stats_update(sc);
1148                 bnx2x_hw_stats_post(sc);
1149                 bnx2x_storm_stats_post(sc);
1150                 DELAY_MS(5);
1151
1152                 if (*stats_comp != DMAE_COMP_VAL) {
1153                         return;
1154                 }
1155
1156                 if (sc->port.pmf) {
1157                         bnx2x_hw_stats_update(sc);
1158                 }
1159
1160                 if (bnx2x_storm_stats_update(sc)) {
1161                         if (sc->stats_pending++ == 3) {
1162                                 rte_panic("storm stats not updated for 3 times");
1163                         }
1164                         return;
1165                 }
1166         } else {
1167                 /*
1168                  * VF doesn't collect HW statistics, and doesn't get completions,
1169                  * performs only update.
1170                  */
1171                 bnx2x_storm_stats_update(sc);
1172         }
1173
1174         bnx2x_drv_stats_update(sc);
1175 }
1176
1177 static void
1178 bnx2x_port_stats_stop(struct bnx2x_softc *sc)
1179 {
1180     struct dmae_command *dmae;
1181     uint32_t opcode;
1182     int loader_idx = PMF_DMAE_C(sc);
1183     uint32_t *stats_comp = BNX2X_SP(sc, stats_comp);
1184
1185     sc->executer_idx = 0;
1186
1187     opcode = bnx2x_dmae_opcode(sc, DMAE_SRC_PCI, DMAE_DST_GRC, FALSE, 0);
1188
1189     if (sc->port.port_stx) {
1190         dmae = BNX2X_SP(sc, dmae[sc->executer_idx++]);
1191
1192         if (sc->func_stx) {
1193             dmae->opcode = bnx2x_dmae_opcode_add_comp(opcode, DMAE_COMP_GRC);
1194         } else {
1195             dmae->opcode = bnx2x_dmae_opcode_add_comp(opcode, DMAE_COMP_PCI);
1196         }
1197
1198         dmae->src_addr_lo = U64_LO(BNX2X_SP_MAPPING(sc, port_stats));
1199         dmae->src_addr_hi = U64_HI(BNX2X_SP_MAPPING(sc, port_stats));
1200         dmae->dst_addr_lo = sc->port.port_stx >> 2;
1201         dmae->dst_addr_hi = 0;
1202         dmae->len = bnx2x_get_port_stats_dma_len(sc);
1203         if (sc->func_stx) {
1204             dmae->comp_addr_lo = (dmae_reg_go_c[loader_idx] >> 2);
1205             dmae->comp_addr_hi = 0;
1206             dmae->comp_val = 1;
1207         } else {
1208             dmae->comp_addr_lo = U64_LO(BNX2X_SP_MAPPING(sc, stats_comp));
1209             dmae->comp_addr_hi = U64_HI(BNX2X_SP_MAPPING(sc, stats_comp));
1210             dmae->comp_val = DMAE_COMP_VAL;
1211
1212             *stats_comp = 0;
1213         }
1214     }
1215
1216     if (sc->func_stx) {
1217         dmae = BNX2X_SP(sc, dmae[sc->executer_idx++]);
1218         dmae->opcode = bnx2x_dmae_opcode_add_comp(opcode, DMAE_COMP_PCI);
1219         dmae->src_addr_lo = U64_LO(BNX2X_SP_MAPPING(sc, func_stats));
1220         dmae->src_addr_hi = U64_HI(BNX2X_SP_MAPPING(sc, func_stats));
1221         dmae->dst_addr_lo = (sc->func_stx >> 2);
1222         dmae->dst_addr_hi = 0;
1223         dmae->len = (sizeof(struct host_func_stats) >> 2);
1224         dmae->comp_addr_lo = U64_LO(BNX2X_SP_MAPPING(sc, stats_comp));
1225         dmae->comp_addr_hi = U64_HI(BNX2X_SP_MAPPING(sc, stats_comp));
1226         dmae->comp_val = DMAE_COMP_VAL;
1227
1228         *stats_comp = 0;
1229     }
1230 }
1231
1232 static void
1233 bnx2x_stats_stop(struct bnx2x_softc *sc)
1234 {
1235     uint8_t update = FALSE;
1236
1237     bnx2x_stats_comp(sc);
1238
1239     if (sc->port.pmf) {
1240         update = bnx2x_hw_stats_update(sc) == 0;
1241     }
1242
1243     update |= bnx2x_storm_stats_update(sc) == 0;
1244
1245     if (update) {
1246
1247         if (sc->port.pmf) {
1248             bnx2x_port_stats_stop(sc);
1249         }
1250
1251         bnx2x_hw_stats_post(sc);
1252         bnx2x_stats_comp(sc);
1253     }
1254 }
1255
1256 static void
1257 bnx2x_stats_do_nothing(__rte_unused struct bnx2x_softc *sc)
1258 {
1259     return;
1260 }
1261
1262 static const struct {
1263     void (*action)(struct bnx2x_softc *sc);
1264     enum bnx2x_stats_state next_state;
1265 } bnx2x_stats_stm[STATS_STATE_MAX][STATS_EVENT_MAX] = {
1266     {
1267     /* DISABLED PMF */ { bnx2x_stats_pmf_update, STATS_STATE_DISABLED },
1268     /*      LINK_UP */ { bnx2x_stats_start,      STATS_STATE_ENABLED },
1269     /*      UPDATE  */ { bnx2x_stats_do_nothing, STATS_STATE_DISABLED },
1270     /*      STOP    */ { bnx2x_stats_do_nothing, STATS_STATE_DISABLED }
1271     },
1272     {
1273     /* ENABLED  PMF */ { bnx2x_stats_pmf_start,  STATS_STATE_ENABLED },
1274     /*      LINK_UP */ { bnx2x_stats_restart,    STATS_STATE_ENABLED },
1275     /*      UPDATE  */ { bnx2x_stats_update,     STATS_STATE_ENABLED },
1276     /*      STOP    */ { bnx2x_stats_stop,       STATS_STATE_DISABLED }
1277     }
1278 };
1279
1280 void bnx2x_stats_handle(struct bnx2x_softc *sc, enum bnx2x_stats_event event)
1281 {
1282         enum bnx2x_stats_state state;
1283
1284         if (unlikely(sc->panic)) {
1285                 return;
1286         }
1287
1288         state = sc->stats_state;
1289         sc->stats_state = bnx2x_stats_stm[state][event].next_state;
1290
1291         bnx2x_stats_stm[state][event].action(sc);
1292
1293         if (event != STATS_EVENT_UPDATE) {
1294                 PMD_DRV_LOG(DEBUG, sc,
1295                                 "state %d -> event %d -> state %d",
1296                                 state, event, sc->stats_state);
1297         }
1298 }
1299
1300 static void
1301 bnx2x_port_stats_base_init(struct bnx2x_softc *sc)
1302 {
1303     struct dmae_command *dmae;
1304     uint32_t *stats_comp = BNX2X_SP(sc, stats_comp);
1305
1306     /* sanity */
1307     if (!sc->port.pmf || !sc->port.port_stx) {
1308         PMD_DRV_LOG(ERR, sc, "BUG!");
1309         return;
1310     }
1311
1312     sc->executer_idx = 0;
1313
1314     dmae = BNX2X_SP(sc, dmae[sc->executer_idx++]);
1315     dmae->opcode = bnx2x_dmae_opcode(sc, DMAE_SRC_PCI, DMAE_DST_GRC,
1316                                    TRUE, DMAE_COMP_PCI);
1317     dmae->src_addr_lo = U64_LO(BNX2X_SP_MAPPING(sc, port_stats));
1318     dmae->src_addr_hi = U64_HI(BNX2X_SP_MAPPING(sc, port_stats));
1319     dmae->dst_addr_lo = (sc->port.port_stx >> 2);
1320     dmae->dst_addr_hi = 0;
1321     dmae->len = bnx2x_get_port_stats_dma_len(sc);
1322     dmae->comp_addr_lo = U64_LO(BNX2X_SP_MAPPING(sc, stats_comp));
1323     dmae->comp_addr_hi = U64_HI(BNX2X_SP_MAPPING(sc, stats_comp));
1324     dmae->comp_val = DMAE_COMP_VAL;
1325
1326     *stats_comp = 0;
1327     bnx2x_hw_stats_post(sc);
1328     bnx2x_stats_comp(sc);
1329 }
1330
1331 /*
1332  * This function will prepare the statistics ramrod data the way
1333  * we will only have to increment the statistics counter and
1334  * send the ramrod each time we have to.
1335  */
1336 static void
1337 bnx2x_prep_fw_stats_req(struct bnx2x_softc *sc)
1338 {
1339     int i;
1340     int first_queue_query_index;
1341     struct stats_query_header *stats_hdr = &sc->fw_stats_req->hdr;
1342     phys_addr_t cur_data_offset;
1343     struct stats_query_entry *cur_query_entry;
1344
1345     stats_hdr->cmd_num = sc->fw_stats_num;
1346     stats_hdr->drv_stats_counter = 0;
1347
1348     /*
1349      * The storm_counters struct contains the counters of completed
1350      * statistics requests per storm which are incremented by FW
1351      * each time it completes hadning a statistics ramrod. We will
1352      * check these counters in the timer handler and discard a
1353      * (statistics) ramrod completion.
1354      */
1355     cur_data_offset = (sc->fw_stats_data_mapping +
1356                        offsetof(struct bnx2x_fw_stats_data, storm_counters));
1357
1358     stats_hdr->stats_counters_addrs.hi = htole32(U64_HI(cur_data_offset));
1359     stats_hdr->stats_counters_addrs.lo = htole32(U64_LO(cur_data_offset));
1360
1361     /*
1362      * Prepare the first stats ramrod (will be completed with
1363      * the counters equal to zero) - init counters to somethig different.
1364      */
1365     memset(&sc->fw_stats_data->storm_counters, 0xff,
1366            sizeof(struct stats_counter));
1367
1368     /**** Port FW statistics data ****/
1369     cur_data_offset = (sc->fw_stats_data_mapping +
1370                        offsetof(struct bnx2x_fw_stats_data, port));
1371
1372     cur_query_entry = &sc->fw_stats_req->query[BNX2X_PORT_QUERY_IDX];
1373
1374     cur_query_entry->kind = STATS_TYPE_PORT;
1375     /* For port query index is a DONT CARE */
1376     cur_query_entry->index = SC_PORT(sc);
1377     /* For port query funcID is a DONT CARE */
1378     cur_query_entry->funcID = htole16(SC_FUNC(sc));
1379     cur_query_entry->address.hi = htole32(U64_HI(cur_data_offset));
1380     cur_query_entry->address.lo = htole32(U64_LO(cur_data_offset));
1381
1382     /**** PF FW statistics data ****/
1383     cur_data_offset = (sc->fw_stats_data_mapping +
1384                        offsetof(struct bnx2x_fw_stats_data, pf));
1385
1386     cur_query_entry = &sc->fw_stats_req->query[BNX2X_PF_QUERY_IDX];
1387
1388     cur_query_entry->kind = STATS_TYPE_PF;
1389     /* For PF query index is a DONT CARE */
1390     cur_query_entry->index = SC_PORT(sc);
1391     cur_query_entry->funcID = htole16(SC_FUNC(sc));
1392     cur_query_entry->address.hi = htole32(U64_HI(cur_data_offset));
1393     cur_query_entry->address.lo = htole32(U64_LO(cur_data_offset));
1394
1395     /**** Clients' queries ****/
1396     cur_data_offset = (sc->fw_stats_data_mapping +
1397                        offsetof(struct bnx2x_fw_stats_data, queue_stats));
1398
1399     /*
1400      * First queue query index depends whether FCoE offloaded request will
1401      * be included in the ramrod
1402      */
1403         first_queue_query_index = (BNX2X_FIRST_QUEUE_QUERY_IDX - 1);
1404
1405     for (i = 0; i < sc->num_queues; i++) {
1406         cur_query_entry =
1407             &sc->fw_stats_req->query[first_queue_query_index + i];
1408
1409         cur_query_entry->kind = STATS_TYPE_QUEUE;
1410         cur_query_entry->index = bnx2x_stats_id(&sc->fp[i]);
1411         cur_query_entry->funcID = htole16(SC_FUNC(sc));
1412         cur_query_entry->address.hi = htole32(U64_HI(cur_data_offset));
1413         cur_query_entry->address.lo = htole32(U64_LO(cur_data_offset));
1414
1415         cur_data_offset += sizeof(struct per_queue_stats);
1416     }
1417 }
1418
1419 void bnx2x_memset_stats(struct bnx2x_softc *sc)
1420 {
1421         int i;
1422
1423         /* function stats */
1424         for (i = 0; i < sc->num_queues; i++) {
1425                 struct bnx2x_fastpath *fp = &sc->fp[i];
1426
1427                 memset(&fp->old_tclient, 0,
1428                                 sizeof(fp->old_tclient));
1429                 memset(&fp->old_uclient, 0,
1430                                 sizeof(fp->old_uclient));
1431                 memset(&fp->old_xclient, 0,
1432                                 sizeof(fp->old_xclient));
1433                 if (sc->stats_init) {
1434                         memset(&fp->eth_q_stats, 0,
1435                                         sizeof(fp->eth_q_stats));
1436                         memset(&fp->eth_q_stats_old, 0,
1437                                         sizeof(fp->eth_q_stats_old));
1438                 }
1439         }
1440
1441         if (sc->stats_init) {
1442                 memset(&sc->net_stats_old, 0, sizeof(sc->net_stats_old));
1443                 memset(&sc->fw_stats_old, 0, sizeof(sc->fw_stats_old));
1444                 memset(&sc->eth_stats_old, 0, sizeof(sc->eth_stats_old));
1445                 memset(&sc->eth_stats, 0, sizeof(sc->eth_stats));
1446                 memset(&sc->func_stats, 0, sizeof(sc->func_stats));
1447         }
1448
1449         sc->stats_state = STATS_STATE_DISABLED;
1450
1451         if (sc->port.pmf && sc->port.port_stx)
1452                 bnx2x_port_stats_base_init(sc);
1453
1454         /* mark the end of statistics initializiation */
1455         sc->stats_init = false;
1456 }
1457
1458 void
1459 bnx2x_stats_init(struct bnx2x_softc *sc)
1460 {
1461         int /*abs*/port = SC_PORT(sc);
1462         int mb_idx = SC_FW_MB_IDX(sc);
1463         int i;
1464
1465         sc->stats_pending = 0;
1466         sc->executer_idx = 0;
1467         sc->stats_counter = 0;
1468
1469         sc->stats_init = TRUE;
1470
1471         /* port and func stats for management */
1472         if (!BNX2X_NOMCP(sc)) {
1473                 sc->port.port_stx = SHMEM_RD(sc, port_mb[port].port_stx);
1474                 sc->func_stx = SHMEM_RD(sc, func_mb[mb_idx].fw_mb_param);
1475         } else {
1476                 sc->port.port_stx = 0;
1477                 sc->func_stx = 0;
1478         }
1479
1480         PMD_DRV_LOG(DEBUG, sc, "port_stx 0x%x func_stx 0x%x",
1481                         sc->port.port_stx, sc->func_stx);
1482
1483         /* pmf should retrieve port statistics from SP on a non-init*/
1484         if (!sc->stats_init && sc->port.pmf && sc->port.port_stx) {
1485                 bnx2x_stats_handle(sc, STATS_EVENT_PMF);
1486         }
1487
1488         port = SC_PORT(sc);
1489         /* port stats */
1490         memset(&(sc->port.old_nig_stats), 0, sizeof(struct nig_stats));
1491         sc->port.old_nig_stats.brb_discard =
1492                 REG_RD(sc, NIG_REG_STAT0_BRB_DISCARD + port*0x38);
1493         sc->port.old_nig_stats.brb_truncate =
1494                 REG_RD(sc, NIG_REG_STAT0_BRB_TRUNCATE + port*0x38);
1495         if (!CHIP_IS_E3(sc)) {
1496                 REG_RD_DMAE(sc, NIG_REG_STAT0_EGRESS_MAC_PKT0 + port*0x50,
1497                                 &(sc->port.old_nig_stats.egress_mac_pkt0_lo), 2);
1498                 REG_RD_DMAE(sc, NIG_REG_STAT0_EGRESS_MAC_PKT1 + port*0x50,
1499                                 &(sc->port.old_nig_stats.egress_mac_pkt1_lo), 2);
1500         }
1501
1502         /* function stats */
1503         for (i = 0; i < sc->num_queues; i++) {
1504                 memset(&sc->fp[i].old_tclient, 0, sizeof(sc->fp[i].old_tclient));
1505                 memset(&sc->fp[i].old_uclient, 0, sizeof(sc->fp[i].old_uclient));
1506                 memset(&sc->fp[i].old_xclient, 0, sizeof(sc->fp[i].old_xclient));
1507                 if (sc->stats_init) {
1508                         memset(&sc->fp[i].eth_q_stats, 0,
1509                                         sizeof(sc->fp[i].eth_q_stats));
1510                         memset(&sc->fp[i].eth_q_stats_old, 0,
1511                                         sizeof(sc->fp[i].eth_q_stats_old));
1512                 }
1513         }
1514
1515         /* prepare statistics ramrod data */
1516         bnx2x_prep_fw_stats_req(sc);
1517
1518         if (sc->stats_init) {
1519                 memset(&sc->net_stats_old, 0, sizeof(sc->net_stats_old));
1520                 memset(&sc->fw_stats_old, 0, sizeof(sc->fw_stats_old));
1521                 memset(&sc->eth_stats_old, 0, sizeof(sc->eth_stats_old));
1522                 memset(&sc->eth_stats, 0, sizeof(sc->eth_stats));
1523                 memset(&sc->func_stats, 0, sizeof(sc->func_stats));
1524
1525                 /* Clean SP from previous statistics */
1526                 if (sc->func_stx) {
1527                         memset(BNX2X_SP(sc, func_stats), 0, sizeof(struct host_func_stats));
1528                         bnx2x_func_stats_init(sc);
1529                         bnx2x_hw_stats_post(sc);
1530                         bnx2x_stats_comp(sc);
1531                 }
1532         }
1533
1534         sc->stats_state = STATS_STATE_DISABLED;
1535
1536         if (sc->port.pmf && sc->port.port_stx) {
1537                 bnx2x_port_stats_base_init(sc);
1538         }
1539
1540         /* mark the end of statistics initializiation */
1541         sc->stats_init = FALSE;
1542 }
1543
1544 void
1545 bnx2x_save_statistics(struct bnx2x_softc *sc)
1546 {
1547         int i;
1548
1549         /* save queue statistics */
1550         for (i = 0; i < sc->num_queues; i++) {
1551                 struct bnx2x_fastpath *fp = &sc->fp[i];
1552                 struct bnx2x_eth_q_stats *qstats = &fp->eth_q_stats;
1553                 struct bnx2x_eth_q_stats_old *qstats_old = &fp->eth_q_stats_old;
1554
1555                 UPDATE_QSTAT_OLD(total_unicast_bytes_received_hi);
1556                 UPDATE_QSTAT_OLD(total_unicast_bytes_received_lo);
1557                 UPDATE_QSTAT_OLD(total_broadcast_bytes_received_hi);
1558                 UPDATE_QSTAT_OLD(total_broadcast_bytes_received_lo);
1559                 UPDATE_QSTAT_OLD(total_multicast_bytes_received_hi);
1560                 UPDATE_QSTAT_OLD(total_multicast_bytes_received_lo);
1561                 UPDATE_QSTAT_OLD(total_unicast_bytes_transmitted_hi);
1562                 UPDATE_QSTAT_OLD(total_unicast_bytes_transmitted_lo);
1563                 UPDATE_QSTAT_OLD(total_broadcast_bytes_transmitted_hi);
1564                 UPDATE_QSTAT_OLD(total_broadcast_bytes_transmitted_lo);
1565                 UPDATE_QSTAT_OLD(total_multicast_bytes_transmitted_hi);
1566                 UPDATE_QSTAT_OLD(total_multicast_bytes_transmitted_lo);
1567         }
1568
1569         /* store port firmware statistics */
1570         if (sc->port.pmf) {
1571                 struct bnx2x_eth_stats *estats = &sc->eth_stats;
1572                 struct bnx2x_fw_port_stats_old *fwstats = &sc->fw_stats_old;
1573                 struct host_port_stats *pstats = BNX2X_SP(sc, port_stats);
1574
1575                 fwstats->pfc_frames_rx_hi = pstats->pfc_frames_rx_hi;
1576                 fwstats->pfc_frames_rx_lo = pstats->pfc_frames_rx_lo;
1577                 fwstats->pfc_frames_tx_hi = pstats->pfc_frames_tx_hi;
1578                 fwstats->pfc_frames_tx_lo = pstats->pfc_frames_tx_lo;
1579
1580                 if (IS_MF(sc)) {
1581                         UPDATE_FW_STAT_OLD(mac_filter_discard);
1582                         UPDATE_FW_STAT_OLD(mf_tag_discard);
1583                         UPDATE_FW_STAT_OLD(brb_truncate_discard);
1584                         UPDATE_FW_STAT_OLD(mac_discard);
1585                 }
1586         }
1587 }