/*
* <:copyright-BRCM:2015:DUAL/GPL:standard
*
*    Copyright (c) 2015 Broadcom
*    All Rights Reserved
*
* Unless you and Broadcom execute a separate written software license
* agreement governing use of this software, this software is licensed
* to you under the terms of the GNU General Public License version 2
* (the "GPL"), available at http://www.broadcom.com/licenses/GPLv2.php,
* with the following added to such license:
*
*    As a special exception, the copyright holders of this software give
*    you permission to link this software with independent modules, and
*    to copy and distribute the resulting executable under terms of your
*    choice, provided that you also meet, for each linked independent
*    module, the terms and conditions of the license of that module.
*    An independent module is a module which is not derived from this
*    software.  The special exception does not apply to any modifications
*    of the software.
*
* Not withstanding the above, under no circumstances may you combine
* this software in any way with any other Broadcom software provided
* under a license other than the GPL, without Broadcom's express prior
* written consent.
*
* :>
*/

#if defined(RDP_SIM)
#include "pktrunner_rdpa_sim.h"
#else
#include "bcm_OS_Deps.h"
#include "bcmenet_common.h"
#endif

#include "rdpa_mw_qos.h"

#define PBIT_VAL_MAX 7

#define rdpa_mw_debug(fmt, arg...) BCM_LOG_DEBUG(BCM_LOG_ID_RDPA, fmt, ##arg)
#define rdpa_mw_info(fmt, arg...) BCM_LOG_INFO(BCM_LOG_ID_RDPA, fmt, ##arg)
#define rdpa_mw_error(fmt, arg...) BCM_LOG_ERROR(BCM_LOG_ID_RDPA, fmt, ##arg)


static BOOL pkt_based_qos_en[2][RDPA_MW_QOS_TYPE_MAX];

int rdpa_mw_pkt_based_qos_get(rdpa_traffic_dir dir,
                            rdpa_mw_qos_type type,
                            BOOL *enable)
{
    if (dir > rdpa_dir_us || type >= RDPA_MW_QOS_TYPE_MAX)
    {
        return -1;
    }
    else
    {
        *enable = pkt_based_qos_en[dir][type];
        return 0;
    }
}
EXPORT_SYMBOL(rdpa_mw_pkt_based_qos_get);

int rdpa_mw_pkt_based_qos_set(rdpa_traffic_dir dir,
                            rdpa_mw_qos_type type,
                            BOOL *enable)
{
    if (dir > rdpa_dir_us || type >= RDPA_MW_QOS_TYPE_MAX)
    {
        return -1;
    }
    else
    {
        pkt_based_qos_en[dir][type] = *enable;
        return 0;
    }
}
EXPORT_SYMBOL(rdpa_mw_pkt_based_qos_set);

int rdpa_mw_drop_precedence_set(rdpa_traffic_dir dir, rdpadrv_dp_code dp_code)
{
    bdmf_object_handle system_obj = NULL;
    int rc = 0;
    int i = 0;
    int ret = 0;
    rdpa_dp_key_t dp_key;

#if defined(CONFIG_BCM96855)
    return 0;
#endif    

    bdmf_lock();

    rc = rdpa_system_get(&system_obj);
    if (rc)
    {
        rdpa_mw_error("rdpa_system_get() failed");
        bdmf_unlock();
        return -1;
    }

    dp_key.dir = dir;

    for (i = 0; i <= PBIT_VAL_MAX; i++)
    {
        dp_key.pbit = i;
        dp_key.dei = 0;
        rdpa_system_drop_precedence_set(system_obj, &dp_key, 0);
        dp_key.dei = 1;
        rdpa_system_drop_precedence_set(system_obj, &dp_key, 0);
    }

    switch (dp_code)
    {
        case RDPADRV_DP_CODE_DEI:
        {
            /* Drop eligibility = true for packets with DEI value 1. */
            for (i = 0; i <= PBIT_VAL_MAX; i++)
            {
                dp_key.pbit = i;
                dp_key.dei = 1;
                rdpa_system_drop_precedence_set(system_obj, &dp_key, 1);
            }
            break;
        }

        case RDPADRV_DP_CODE_PCP6P2D:
        {
            /* Drop eligibility = true for packets with PBIT 2 or 4. */
            dp_key.pbit = 2;
            dp_key.dei = 0;
            rdpa_system_drop_precedence_set(system_obj, &dp_key, 1);
            dp_key.pbit = 2;
            dp_key.dei = 1;
            rdpa_system_drop_precedence_set(system_obj, &dp_key, 1);
            dp_key.pbit = 4;
            dp_key.dei = 0;
            rdpa_system_drop_precedence_set(system_obj, &dp_key, 1);
            dp_key.pbit = 4;
            dp_key.dei = 1;
            rdpa_system_drop_precedence_set(system_obj, &dp_key, 1);
            break;
        }

        case RDPADRV_DP_CODE_NONE:
        case RDPADRV_DP_CODE_INTERNAL:
        {
            break;
        }

        default:
        {
            rdpa_mw_error("Drop precedence code %d is not supported",
              dp_code);
            ret = -1;
            break;
        }
    }

    bdmf_put(system_obj);
    bdmf_unlock();

    return ret;
}
EXPORT_SYMBOL(rdpa_mw_drop_precedence_set);