/*
   Copyright (c) 2015 Broadcom Corporation
   All Rights Reserved

   <:label-BRCM:2015:DUAL/GPL:standard
   
   This program is free software; you can redistribute it and/or modify
   it under the terms of the GNU General Public License, version 2, as published by
   the Free Software Foundation (the "GPL").
   
   This program is distributed in the hope that it will be useful,
   but WITHOUT ANY WARRANTY; without even the implied warranty of
   MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
   GNU General Public License for more details.
   
   
   A copy of the GPL is available at http://www.broadcom.com/licenses/GPLv2.php, or by
   writing to the Free Software Foundation, Inc., 59 Temple Place - Suite 330,
   Boston, MA 02111-1307, USA.
   
   :>
   */
/*
 * lport_stats.c
 *
 *  Created on: 16 áñôè× 2015
 *      Author: yonatani
 */
#include "lport_defs.h"
#include "lport_stats.h"
#include "bcm6858_lport_mib_ag.h"
#include "bcm6858_mib_conf_ag.h"


int lport_stats_get_rx(uint32_t portid, lport_rx_stats_s *rx_stats)
{
    int rc;
    rc = ag_drv_lport_mib_grx64_get(portid, &rx_stats->GRX64);
    rc = rc ? rc :ag_drv_lport_mib_grx127_get(portid, &rx_stats->GRX127);
    rc = rc ? rc :ag_drv_lport_mib_grx255_get(portid, &rx_stats->GRX255);
    rc = rc ? rc :ag_drv_lport_mib_grx511_get(portid,&rx_stats->GRX511);
    rc = rc ? rc :ag_drv_lport_mib_grx1023_get(portid,&rx_stats->GRX1023);
    rc = rc ? rc :ag_drv_lport_mib_grx1518_get(portid,&rx_stats->GRX1518);
    rc = rc ? rc :ag_drv_lport_mib_grx1522_get(portid,&rx_stats->GRX1522);
    rc = rc ? rc :ag_drv_lport_mib_grx2047_get(portid,&rx_stats->GRX2047);
    rc = rc ? rc :ag_drv_lport_mib_grx4095_get(portid,&rx_stats->GRX4095);
    rc = rc ? rc :ag_drv_lport_mib_grx9216_get(portid,&rx_stats->GRX9216);
    rc = rc ? rc :ag_drv_lport_mib_grx16383_get(portid,&rx_stats->GRX16383);
    rc = rc ? rc :ag_drv_lport_mib_grxpkt_get(portid,&rx_stats->GRXPKT);
    rc = rc ? rc :ag_drv_lport_mib_grxuca_get(portid,&rx_stats->GRXUCA);
    rc = rc ? rc :ag_drv_lport_mib_grxmca_get(portid,&rx_stats->GRXMCA);
    rc = rc ? rc :ag_drv_lport_mib_grxbca_get(portid,&rx_stats->GRXBCA);
    rc = rc ? rc :ag_drv_lport_mib_grxfcs_get(portid,&rx_stats->GRXFCS);
    rc = rc ? rc :ag_drv_lport_mib_grxcf_get(portid,&rx_stats->GRXCF);
    rc = rc ? rc :ag_drv_lport_mib_grxpp_get(portid,&rx_stats->GRXPP);
    rc = rc ? rc :ag_drv_lport_mib_grxpf_get(portid,&rx_stats->GRXPF);
    rc = rc ? rc :ag_drv_lport_mib_grxuo_get(portid,&rx_stats->GRXUDA);
    rc = rc ? rc :ag_drv_lport_mib_grxwsa_get(portid,&rx_stats->GRXWSA);
    rc = rc ? rc :ag_drv_lport_mib_grxaln_get(portid,&rx_stats->GRXALN);
    rc = rc ? rc :ag_drv_lport_mib_grxflr_get(portid,&rx_stats->GRXFLR);
    rc = rc ? rc :ag_drv_lport_mib_grxfrerr_get(portid,&rx_stats->GRXFRERR);
    rc = rc ? rc :ag_drv_lport_mib_grxfcr_get(portid,&rx_stats->GRXFCR);
    rc = rc ? rc :ag_drv_lport_mib_grxovr_get(portid,&rx_stats->GRXOVR);
    rc = rc ? rc :ag_drv_lport_mib_grxjbr_get(portid,&rx_stats->GRXJBR);
    rc = rc ? rc :ag_drv_lport_mib_grxmtue_get(portid,&rx_stats->GRXMTUE);
    rc = rc ? rc :ag_drv_lport_mib_grxmcrc_get(portid,&rx_stats->GRXMCRC);
    rc = rc ? rc :ag_drv_lport_mib_grxprm_get(portid,&rx_stats->GRXPRM);
    rc = rc ? rc :ag_drv_lport_mib_grxvln_get(portid,&rx_stats->GRXVLN);
    rc = rc ? rc :ag_drv_lport_mib_grxdvln_get(portid,&rx_stats->GRXDVLN);
    rc = rc ? rc :ag_drv_lport_mib_grxtrfu_get(portid,&rx_stats->GRXTRFU);
    rc = rc ? rc :ag_drv_lport_mib_grxpok_get(portid,&rx_stats->GRXPOK);
    rc = rc ? rc :ag_drv_lport_mib_grxschcrc_get(portid, &rx_stats->GRXSCHCRC);
    rc = rc ? rc :ag_drv_lport_mib_grxbyt_get(portid,&rx_stats->GRXBYT);
    rc = rc ? rc :ag_drv_lport_mib_grxrpkt_get(portid,&rx_stats->GRXRPKT);
    rc = rc ? rc :ag_drv_lport_mib_grxund_get(portid,&rx_stats->GRXUND);
    rc = rc ? rc :ag_drv_lport_mib_grxfrg_get(portid,&rx_stats->GRXFRG);
    rc = rc ? rc :ag_drv_lport_mib_grxrbyt_get(portid,&rx_stats->GRXRBYT);
    rc = rc ? rc :ag_drv_lport_mib_grxlpi_get(portid,&rx_stats->GRXLPI);
    rc = rc ? rc :ag_drv_lport_mib_grxdlpi_get(portid,&rx_stats->GRXDLPI);
    rc = rc ? rc :ag_drv_lport_mib_grxptllfc_get(portid,&rx_stats->GRXPTLLFC);
    rc = rc ? rc :ag_drv_lport_mib_grxltllfc_get(portid,&rx_stats->GRXLTLLFC);
    rc = rc ? rc :ag_drv_lport_mib_grxllfcfcs_get(portid,&rx_stats->GRXLLFCFCS);
    rc = rc ? rc :ag_drv_lport_mib_grxuo_get(portid, &rx_stats->GRXUO);
    return rc;
}

int lport_stats_get_tx(uint32_t portid, lport_tx_stats_s *tx_stats)
{
    int rc;
    rc = ag_drv_lport_mib_gtx64_get(portid, &tx_stats->GTX64);
    rc = rc ? rc :ag_drv_lport_mib_gtx127_get(portid, &tx_stats->GTX127);
    rc = rc ? rc :ag_drv_lport_mib_gtx255_get(portid, &tx_stats->GTX255);
    rc = rc ? rc :ag_drv_lport_mib_gtx511_get(portid, &tx_stats->GTX511);
    rc = rc ? rc :ag_drv_lport_mib_gtx1023_get(portid, &tx_stats->GTX1023);
    rc = rc ? rc :ag_drv_lport_mib_gtx1518_get(portid, &tx_stats->GTX1518);
    rc = rc ? rc :ag_drv_lport_mib_gtx1522_get(portid, &tx_stats->GTX1522);
    rc = rc ? rc :ag_drv_lport_mib_gtx2047_get(portid, &tx_stats->GTX2047);
    rc = rc ? rc :ag_drv_lport_mib_gtx4095_get(portid, &tx_stats->GTX4095);
    rc = rc ? rc :ag_drv_lport_mib_gtx9216_get(portid, &tx_stats->GTX9216);
    rc = rc ? rc :ag_drv_lport_mib_gtx16383_get(portid, &tx_stats->GTX16383);
    rc = rc ? rc :ag_drv_lport_mib_gtxpok_get(portid, &tx_stats->GTXPOK);
    rc = rc ? rc :ag_drv_lport_mib_gtxpkt_get(portid, &tx_stats->GTXPKT);
    rc = rc ? rc :ag_drv_lport_mib_gtxuca_get(portid, &tx_stats->GTXUCA);
    rc = rc ? rc :ag_drv_lport_mib_gtxmca_get(portid, &tx_stats->GTXMCA);
    rc = rc ? rc :ag_drv_lport_mib_gtxbca_get(portid, &tx_stats->GTXBCA);
    rc = rc ? rc :ag_drv_lport_mib_gtxpf_get(portid, &tx_stats->GTXPF);
    rc = rc ? rc :ag_drv_lport_mib_gtxpfc_get(portid, &tx_stats->GTXPFC);
    rc = rc ? rc :ag_drv_lport_mib_gtxjbr_get(portid, &tx_stats->GTXJBR);
    rc = rc ? rc :ag_drv_lport_mib_gtxfcs_get(portid, &tx_stats->GTXFCS);
    rc = rc ? rc :ag_drv_lport_mib_gtxcf_get(portid, &tx_stats->GTXCF);
    rc = rc ? rc :ag_drv_lport_mib_gtxovr_get(portid, &tx_stats->GTXOVR);
    rc = rc ? rc :ag_drv_lport_mib_gtxdfr_get(portid, &tx_stats->GTXDFR);
    rc = rc ? rc :ag_drv_lport_mib_gtxedf_get(portid, &tx_stats->GTXEDF);
    rc = rc ? rc :ag_drv_lport_mib_gtxscl_get(portid, &tx_stats->GTXSCL);
    rc = rc ? rc :ag_drv_lport_mib_gtxmcl_get(portid, &tx_stats->GTXMCL);
    rc = rc ? rc :ag_drv_lport_mib_gtxlcl_get(portid, &tx_stats->GTXLCL);
    rc = rc ? rc :ag_drv_lport_mib_gtxxcl_get(portid, &tx_stats->GTXXCL);
    rc = rc ? rc :ag_drv_lport_mib_gtxfrg_get(portid, &tx_stats->GTXFRG);
    rc = rc ? rc :ag_drv_lport_mib_gtxerr_get(portid, &tx_stats->GTXERR);
    rc = rc ? rc :ag_drv_lport_mib_gtxvln_get(portid, &tx_stats->GTXVLN);
    rc = rc ? rc :ag_drv_lport_mib_gtxdvln_get(portid, &tx_stats->GTXDVLN);
    rc = rc ? rc :ag_drv_lport_mib_gtxrpkt_get(portid, &tx_stats->GTXRPKT);
    rc = rc ? rc :ag_drv_lport_mib_gtxufl_get(portid, &tx_stats->GTXUFL);
    rc = rc ? rc :ag_drv_lport_mib_gtxncl_get(portid, &tx_stats->GTXNCL);
    rc = rc ? rc :ag_drv_lport_mib_gtxbyt_get(portid, &tx_stats->GTXBYT);
    rc = rc ? rc :ag_drv_lport_mib_gtxlpi_get(portid, &tx_stats->GTXLPI);
    rc = rc ? rc :ag_drv_lport_mib_gtxdlpi_get(portid, &tx_stats->GTXDLPI);
    rc = rc ? rc :ag_drv_lport_mib_gtxltllfc_get(portid, &tx_stats->GTXLTLLFC);
    return rc;
}

int lport_stats_rst_rx_single(uint32_t portid,  LPORT_STATS_RX_TYPE stat_type)
{
    switch(stat_type)
    {
    case (STAT_GRX64):
        return ag_drv_lport_mib_gtx64_set(portid, 0);
    case (STAT_GRX127):
        return ag_drv_lport_mib_grx127_set(portid, 0);
    case (STAT_GRX255):
        return ag_drv_lport_mib_grx255_set(portid, 0);
    case (STAT_GRX511):
        return ag_drv_lport_mib_grx511_set(portid, 0);
    case (STAT_GRX1023):
        return ag_drv_lport_mib_grx1023_set(portid, 0);
    case (STAT_GRX1518):
        return ag_drv_lport_mib_grx1518_set(portid, 0);
    case (STAT_GRX1522):
        return ag_drv_lport_mib_grx1522_set(portid, 0);
    case (STAT_GRX2047):
        return ag_drv_lport_mib_grx2047_set(portid, 0);
    case (STAT_GRX4095):
        return ag_drv_lport_mib_grx4095_set(portid, 0);
    case (STAT_GRX9216):
        return ag_drv_lport_mib_grx9216_set(portid, 0);
    case (STAT_GRX16383):
        return ag_drv_lport_mib_grx16383_set(portid, 0);
    case (STAT_GRXPKT):
        return ag_drv_lport_mib_grxpkt_set(portid, 0);
    case (STAT_GRXUCA):
        return ag_drv_lport_mib_grxuca_set(portid, 0);
    case (STAT_GRXMCA):
        return ag_drv_lport_mib_grxmca_set(portid, 0);
    case (STAT_GRXBCA):
        return ag_drv_lport_mib_grxbca_set(portid, 0);
    case (STAT_GRXFCS):
        return ag_drv_lport_mib_grxfcs_set(portid, 0);
    case (STAT_GRXCF):
        return ag_drv_lport_mib_grxcf_set(portid, 0);
    case (STAT_GRXPF):
        return ag_drv_lport_mib_grxpp_set(portid, 0);
    case (STAT_GRXPP):
        return ag_drv_lport_mib_grxuo_set(portid, 0);
    case (STAT_GRXUO):
        return ag_drv_lport_mib_grxuda_set(portid, 0);
    case (STAT_GRXUDA):
        return ag_drv_lport_mib_grxwsa_set(portid, 0);
    case (STAT_GRXWSA):
        return ag_drv_lport_mib_grxaln_set(portid, 0);
    case (STAT_GRXALN):
        return ag_drv_lport_mib_grxflr_set(portid, 0);
    case (STAT_GRXFLR):
        return ag_drv_lport_mib_grxflr_set(portid, 0);
    case (STAT_GRXFRERR):
        return ag_drv_lport_mib_grxfrerr_set(portid, 0);
    case (STAT_GRXFCR):
        return ag_drv_lport_mib_grxfcr_set(portid, 0);
    case (STAT_GRXOVR):
        return ag_drv_lport_mib_grxovr_set(portid, 0);
    case (STAT_GRXJBR):
        return ag_drv_lport_mib_grxjbr_set(portid, 0);
    case (STAT_GRXMTUE):
        return ag_drv_lport_mib_grxmtue_set(portid, 0);
    case (STAT_GRXMCRC):
        return ag_drv_lport_mib_grxmcrc_set(portid, 0);
    case (STAT_GRXPRM):
        return ag_drv_lport_mib_grxprm_set(portid, 0);
    case (STAT_GRXVLN):
        return ag_drv_lport_mib_grxvln_set(portid, 0);
    case (STAT_GRXDVLN):
        return ag_drv_lport_mib_grxdvln_set(portid, 0);
    case (STAT_GRXTRFU):
        return ag_drv_lport_mib_grxtrfu_set(portid, 0);
    case (STAT_GRXPOK):
        return ag_drv_lport_mib_grxpok_set(portid, 0);
    case (STAT_GRXSCHCRC):
        return ag_drv_lport_mib_grxschcrc_set(portid, 0);
    case (STAT_GRXBYT):
        return ag_drv_lport_mib_grxbyt_set(portid, 0);
    case (STAT_GRXRPKT):
        return ag_drv_lport_mib_grxrpkt_set(portid, 0);
    case (STAT_GRXUND):
        return ag_drv_lport_mib_grxund_set(portid, 0);
    case (STAT_GRXFRG):
        return ag_drv_lport_mib_grxfrg_set(portid, 0);
    case (STAT_GRXRBYT):
        return ag_drv_lport_mib_grxrbyt_set(portid, 0);
    case (STAT_GRXLPI):
        return ag_drv_lport_mib_grxlpi_set(portid, 0);
    case (STAT_GRXDLPI):
        return ag_drv_lport_mib_grxdlpi_set(portid, 0);
    case (STAT_GRXPTLLFC):
        return ag_drv_lport_mib_grxptllfc_set(portid, 0);
    case (STAT_GRXLTLLFC):
        return ag_drv_lport_mib_grxltllfc_set(portid, 0);
    case (STAT_GRXLLFCFCS):
        return ag_drv_lport_mib_grxllfcfcs_set(portid, 0);
    default:
        return LPORT_ERR_PARAM;
    }

    return LPORT_ERR_OK;
}

int lport_stats_rst_tx_single(uint32_t portid,  LPORT_STATS_TX_TYPE stat_type)
{
    switch(stat_type)
    {
    case(STAT_GTX64):
        return ag_drv_lport_mib_gtx64_set(portid, 0);
    case(STAT_GTX127):
        return ag_drv_lport_mib_gtx127_set(portid, 0);
    case(STAT_GTX255):
        return ag_drv_lport_mib_gtx255_set(portid, 0);
    case(STAT_GTX511):
        return ag_drv_lport_mib_gtx511_set(portid, 0);
    case(STAT_GTX1023):
        return ag_drv_lport_mib_gtx1023_set(portid, 0);
    case(STAT_GTX1518):
        return ag_drv_lport_mib_gtx1518_set(portid, 0);
    case(STAT_GTX1522):
        return ag_drv_lport_mib_gtx1522_set(portid, 0);
    case(STAT_GTX2047):
        return ag_drv_lport_mib_gtx2047_set(portid, 0);
    case(STAT_GTX4095):
        return ag_drv_lport_mib_gtx4095_set(portid, 0);
    case(STAT_GTX9216):
        return ag_drv_lport_mib_gtx9216_set(portid, 0);
    case(STAT_GTX16383):
        return ag_drv_lport_mib_gtx16383_set(portid, 0);
    case(STAT_GTXPOK):
        return ag_drv_lport_mib_gtxpok_set(portid, 0);
    case(STAT_GTXPKT):
        return ag_drv_lport_mib_gtxpkt_set(portid, 0);
    case(STAT_GTXUCA):
        return ag_drv_lport_mib_gtxuca_set(portid, 0);
    case(STAT_GTXMCA):
        return ag_drv_lport_mib_gtxmca_set(portid, 0);
    case(STAT_GTXBCA):
        return ag_drv_lport_mib_gtxbca_set(portid, 0);
    case(STAT_GTXPF):
        return ag_drv_lport_mib_gtxpf_set(portid, 0);
    case(STAT_GTXPFC):
        return ag_drv_lport_mib_gtxpfc_set(portid, 0);
    case(STAT_GTXJBR):
        return ag_drv_lport_mib_gtxjbr_set(portid, 0);
    case(STAT_GTXFCS):
        return ag_drv_lport_mib_gtxfcs_set(portid, 0);
    case(STAT_GTXCF):
        return ag_drv_lport_mib_gtxcf_set(portid, 0);
    case(STAT_GTXOVR):
        return ag_drv_lport_mib_gtxovr_set(portid, 0);
    case(STAT_GTXDFR):
        return ag_drv_lport_mib_gtxdfr_set(portid, 0);
    case(STAT_GTXEDF):
        return ag_drv_lport_mib_gtxedf_set(portid, 0);
    case(STAT_GTXSCL):
        return ag_drv_lport_mib_gtxscl_set(portid, 0);
    case(STAT_GTXMCL):
        return ag_drv_lport_mib_gtxmcl_set(portid, 0);
    case(STAT_GTXLCL):
        return ag_drv_lport_mib_gtxlcl_set(portid, 0);
    case(STAT_GTXXCL):
        return ag_drv_lport_mib_gtxxcl_set(portid, 0);
    case(STAT_GTXFRG):
        return ag_drv_lport_mib_gtxfrg_set(portid, 0);
    case(STAT_GTXERR):
        return ag_drv_lport_mib_gtxerr_set(portid, 0);
    case(STAT_GTXVLN):
        return ag_drv_lport_mib_gtxvln_set(portid, 0);
    case(STAT_GTXDVLN):
        return ag_drv_lport_mib_gtxdvln_set(portid, 0);
    case(STAT_GTXRPKT):
        return ag_drv_lport_mib_gtxrpkt_set(portid, 0);
    case(STAT_GTXUFL):
        return ag_drv_lport_mib_gtxufl_set(portid, 0);
    case(STAT_GTXNCL):
        return ag_drv_lport_mib_gtxncl_set(portid, 0);
    case(STAT_GTXBYT):
        return ag_drv_lport_mib_gtxbyt_set(portid, 0);
    case(STAT_GTXLPI):
        return ag_drv_lport_mib_gtxlpi_set(portid, 0);
    case(STAT_GTXDLPI):
        return ag_drv_lport_mib_gtxdlpi_set(portid, 0);
    case(STAT_GTXLTLLFC):
        return ag_drv_lport_mib_gtxltllfc_set(portid, 0);
    default:
        return LPORT_ERR_PARAM;
    }
    return LPORT_ERR_OK;
}

int lport_stats_cfg_set(uint32_t portid, lport_stats_cfg_s *stats_cfg)
{
    uint8_t xlmacid = portid >> 2;
    uint8_t instance = portid % 4;
    uint8_t eee_cnt_mode;
    uint8_t saturate_en;
    uint8_t cor_en;
    uint8_t cnt_rst;

    ag_drv_mib_conf_control_get(xlmacid, &eee_cnt_mode, &saturate_en,
        &cor_en, &cnt_rst);

    if(stats_cfg->saturate_en)
        saturate_en |= (1 << instance);
    else
        saturate_en &= ~(1 << instance);

    if(stats_cfg->cor_en)
        cor_en |= (1 << instance);
    else
        cor_en &= ~(1 << instance);

    return ag_drv_mib_conf_control_set(xlmacid, eee_cnt_mode, saturate_en,
        cor_en, cnt_rst);
}

int lport_stats_cfg_get(uint32_t portid, lport_stats_cfg_s *stats_cfg)
{
    uint8_t xlmacid = portid >> 2;
    uint8_t instance = portid % 4;
    uint8_t eee_sym_mode;
    uint8_t saturate_en;
    uint8_t cor_en;
    uint8_t cnt_rst;

    ag_drv_mib_conf_control_get(xlmacid, &eee_sym_mode, &saturate_en,
        &cor_en, &cnt_rst);

    stats_cfg->saturate_en = (saturate_en & (1 << instance)) != 0;
    stats_cfg->eee_sym_mode = (eee_sym_mode & (1 << instance)) != 0;
    stats_cfg->cor_en =( cor_en & (1 << instance)) != 0;

    return 0;
}

int lport_stats_reset(uint32_t portid)
{
    uint8_t xlmacid = portid >> 2;
    uint8_t instance = portid % 4;
    uint8_t eee_cnt_mode;
    uint8_t saturate_en;
    uint8_t cor_en;
    uint8_t cnt_rst;

    ag_drv_mib_conf_control_get(xlmacid, &eee_cnt_mode, &saturate_en,
        &cor_en, &cnt_rst);

    cnt_rst |= (1 << instance);

    ag_drv_mib_conf_control_set(xlmacid, eee_cnt_mode, saturate_en,
        cor_en, cnt_rst );

    cnt_rst &= ~(1 << instance);

    ag_drv_mib_conf_control_set(xlmacid, eee_cnt_mode, saturate_en,
        cor_en, cnt_rst );

    return 0;
}