rtl8367c_asicdrv_eav.c

/*
 * Copyright (C) 2013 Realtek Semiconductor Corp.
 * All Rights Reserved.
 *
 * This program is the proprietary software of Realtek Semiconductor
 * Corporation and/or its licensors, and only be used, duplicated,
 * modified or distributed under the authorized license from Realtek.
 *
 * ANY USE OF THE SOFTWARE OTHER THAN AS AUTHORIZED UNDER
 * THIS LICENSE OR COPYRIGHT LAW IS PROHIBITED.
 *
 * $Revision: 79623 $
 * $Date: 2017-06-14 17:15:42 +0800 (週三, 14 六月 2017) $
 *
 * Purpose : RTL8367C switch high-level API for RTL8367C
 * Feature : Ethernet AV related functions
 *
 */

#include "rtl8367c_asicdrv_eav.h"
/* Function Name:
 *      rtl8367c_setAsicEavMacAddress
 * Description:
 *      Set PTP MAC address
 * Input:
 *      mac     - PTP mac
 * Output:
 *      None
 * Return:
 *      RT_ERR_OK         - Success
 *      RT_ERR_SMI      - SMI access error
 * Note:
 *      None
 */
ret_t rtl8367c_setAsicEavMacAddress(ether_addr_t mac)
{
    ret_t retVal;
    rtk_uint32 regData;
    rtk_uint8 *accessPtr;
    rtk_uint32 i;

    accessPtr = (rtk_uint8 *)&mac;

    for (i = 0; i <= 2; i++)
    {
        regData = (*(accessPtr + (i * 2)) << 8) | *(accessPtr + (i * 2) + 1);
        retVal = rtl8367c_setAsicReg(RTL8367C_REG_MAC_ADDR_H - i, regData);
        if (retVal != RT_ERR_OK)
            return retVal;
    }

    return retVal;
}
/* Function Name:
 *      rtl8367c_getAsicEavMacAddress
 * Description:
 *      Get PTP MAC address
 * Input:
 *      None
 * Output:
 *      pMac     - PTP  mac
 * Return:
 *      RT_ERR_OK         - Success
 *      RT_ERR_SMI      - SMI access error
 * Note:
 *      None
 */
ret_t rtl8367c_getAsicEavMacAddress(ether_addr_t *pMac)
{
    ret_t retVal;
    rtk_uint32 regData;
    rtk_uint8 *accessPtr;
    rtk_uint32 i;

    accessPtr = (rtk_uint8 *)pMac;

    for (i = 0; i <= 2; i++)
    {
        retVal = rtl8367c_getAsicReg(RTL8367C_REG_MAC_ADDR_H - i, &regData);
        if (retVal != RT_ERR_OK)
            return retVal;

        *accessPtr = (regData & 0xFF00) >> 8;
        accessPtr++;
        *accessPtr = regData & 0xFF;
        accessPtr++;
    }

    return retVal;
}

/* Function Name:
 *      rtl8367c_setAsicEavTpid
 * Description:
 *      Set PTP parser tag TPID.
 * Input:
 *       outerTag - outter tag TPID
 *       innerTag  - inner tag TPID
 * Output:
 *      None
 * Return:
 *      RT_ERR_OK   - Success
 *      RT_ERR_SMI  - SMI access error
 * Note:
 *     None
 */
ret_t rtl8367c_setAsicEavTpid(rtk_uint32 outerTag, rtk_uint32 innerTag)
{
    ret_t retVal;

    if ((retVal = rtl8367c_setAsicReg(RTL8367C_REG_OTAG_TPID, outerTag)) != RT_ERR_OK)
        return retVal;
    if ((retVal = rtl8367c_setAsicReg(RTL8367C_REG_ITAG_TPID, innerTag)) != RT_ERR_OK)
        return retVal;

    return RT_ERR_OK;
}
/* Function Name:
 *      rtl8367c_getAsicEavTpid
 * Description:
 *      Get PTP parser tag TPID.
 * Input:
 *      None
 * Output:
 *       pOuterTag - outter tag TPID
 *       pInnerTag  - inner tag TPID
 * Return:
 *      RT_ERR_OK   - Success
 *      RT_ERR_SMI  - SMI access error
 * Note:
 *      None
 */
ret_t rtl8367c_getAsicEavTpid(rtk_uint32 *pOuterTag, rtk_uint32 *pInnerTag)
{
    ret_t retVal;

    if ((retVal = rtl8367c_getAsicReg(RTL8367C_REG_OTAG_TPID, pOuterTag)) != RT_ERR_OK)
        return retVal;
    if ((retVal = rtl8367c_getAsicReg(RTL8367C_REG_ITAG_TPID, pInnerTag)) != RT_ERR_OK)
        return retVal;

    return RT_ERR_OK;
}

/* Function Name:
 *      rtl8367c_setAsicEavSysTime
 * Description:
 *      Set PTP system time
 * Input:
 *      second - seconds
 *      nanoSecond - nano seconds
 * Output:
 *      None
 * Return:
 *      RT_ERR_OK     - Success
 *      RT_ERR_SMI  - SMI access error
 * Note:
 *      The time granuality is 8 nano seconds.
 */
ret_t rtl8367c_setAsicEavSysTime(rtk_uint32 second, rtk_uint32 nanoSecond)
{
    ret_t retVal;
    rtk_uint32 sec_h, sec_l, nsec8_h, nsec8_l;
    rtk_uint32 nano_second_8;
    rtk_uint32 regData, busyFlag, count;

    if (nanoSecond > RTL8367C_EAV_NANOSECONDMAX)
        return RT_ERR_INPUT;

    regData = 0;
    sec_h = second >> 16;
    sec_l = second & 0xFFFF;
    nano_second_8 = nanoSecond >> 3;
    nsec8_h = (nano_second_8 >> 16) & RTL8367C_PTP_TIME_NSEC_H_NSEC_MASK;
    nsec8_l = nano_second_8 & 0xFFFF;

    if ((retVal = rtl8367c_setAsicReg(RTL8367C_REG_PTP_TIME_SEC_H_SEC, sec_h)) != RT_ERR_OK)
        return retVal;
    if ((retVal = rtl8367c_setAsicReg(RTL8367C_REG_PTP_TIME_SEC_L_SEC, sec_l)) != RT_ERR_OK)
        return retVal;
    if ((retVal = rtl8367c_setAsicReg(RTL8367C_REG_PTP_TIME_NSEC_L_NSEC, nsec8_l)) != RT_ERR_OK)
        return retVal;

    regData = nsec8_h | (PTP_TIME_WRITE << RTL8367C_PTP_TIME_NSEC_H_CMD_OFFSET) | RTL8367C_PTP_TIME_NSEC_H_EXEC_MASK;

    if ((retVal = rtl8367c_setAsicReg(RTL8367C_REG_PTP_TIME_NSEC_H_NSEC, regData)) != RT_ERR_OK)
        return retVal;

    count = 0;
    do
    {
        if ((retVal = rtl8367c_getAsicRegBit(RTL8367C_REG_PTP_TIME_NSEC_H_NSEC, RTL8367C_PTP_TIME_NSEC_H_EXEC_OFFSET, &busyFlag)) != RT_ERR_OK)
            return retVal;
        count++;
    } while ((busyFlag != 0) && (count < 5));

    if (busyFlag != 0)
        return RT_ERR_BUSYWAIT_TIMEOUT;

    return RT_ERR_OK;
}

/* Function Name:
 *      rtl8367c_getAsicEavSysTime
 * Description:
 *      Get PTP system time
 * Input:
 *      None
 * Output:
 *      second - seconds
 *      nanoSecond - nano seconds
 * Return:
 *      RT_ERR_OK     - Success
 *      RT_ERR_SMI  - SMI access error
 * Note:
 *      The time granuality is 8 nano seconds.
 */
ret_t rtl8367c_getAsicEavSysTime(rtk_uint32 *pSecond, rtk_uint32 *pNanoSecond)
{
    ret_t retVal;
    rtk_uint32 sec_h, sec_l, nsec8_h, nsec8_l;
    rtk_uint32 nano_second_8;
    rtk_uint32 regData, busyFlag, count;

    regData = 0;
    regData = (PTP_TIME_READ << RTL8367C_PTP_TIME_NSEC_H_CMD_OFFSET) | RTL8367C_PTP_TIME_NSEC_H_EXEC_MASK;

    if ((retVal = rtl8367c_setAsicReg(RTL8367C_REG_PTP_TIME_NSEC_H_NSEC, regData)) != RT_ERR_OK)
        return retVal;

    count = 0;
    do
    {
        if ((retVal = rtl8367c_getAsicRegBit(RTL8367C_REG_PTP_TIME_NSEC_H_NSEC, RTL8367C_PTP_TIME_NSEC_H_EXEC_OFFSET, &busyFlag)) != RT_ERR_OK)
            return retVal;
        count++;
    } while ((busyFlag != 0) && (count < 5));

    if (busyFlag != 0)
        return RT_ERR_BUSYWAIT_TIMEOUT;

    if ((retVal = rtl8367c_getAsicReg(RTL8367C_REG_PTP_TIME_SEC_H_SEC_RD, &sec_h)) != RT_ERR_OK)
        return retVal;
    if ((retVal = rtl8367c_getAsicReg(RTL8367C_REG_PTP_TIME_SEC_L_SEC_RD, &sec_l)) != RT_ERR_OK)
        return retVal;
    if ((retVal = rtl8367c_getAsicRegBits(RTL8367C_REG_PTP_TIME_NSEC_H_NSEC_RD, RTL8367C_PTP_TIME_NSEC_H_NSEC_RD_MASK, &nsec8_h)) != RT_ERR_OK)
        return retVal;
    if ((retVal = rtl8367c_getAsicReg(RTL8367C_REG_PTP_TIME_NSEC_L_NSEC_RD, &nsec8_l)) != RT_ERR_OK)
        return retVal;

    *pSecond = (sec_h << 16) | sec_l;
    nano_second_8 = (nsec8_h << 16) | nsec8_l;
    *pNanoSecond = nano_second_8 << 3;

    return RT_ERR_OK;
}

/* Function Name:
 *      rtl8367c_setAsicEavSysTimeAdjust
 * Description:
 *      Set PTP system time adjust
 * Input:
 *      type - incresae or decrease
 *      second - seconds
 *      nanoSecond - nano seconds
 * Output:
 *      None
 * Return:
 *      RT_ERR_OK     - Success
 *      RT_ERR_SMI  - SMI access error
 * Note:
 *      Ethernet AV second offset of timer for tuning
 */
ret_t rtl8367c_setAsicEavSysTimeAdjust(rtk_uint32 type, rtk_uint32 second, rtk_uint32 nanoSecond)
{
    ret_t retVal;
    rtk_uint32 sec_h, sec_l, nsec8_h, nsec8_l;
    rtk_uint32 nano_second_8;
    rtk_uint32 regData, busyFlag, count;

    if (type >= PTP_TIME_ADJ_END)
        return RT_ERR_INPUT;
    if (nanoSecond > RTL8367C_EAV_NANOSECONDMAX)
        return RT_ERR_INPUT;

    regData = 0;
    sec_h = second >> 16;
    sec_l = second & 0xFFFF;
    nano_second_8 = nanoSecond >> 3;
    nsec8_h = (nano_second_8 >> 16) & RTL8367C_PTP_TIME_NSEC_H_NSEC_MASK;
    nsec8_l = nano_second_8 & 0xFFFF;

    if ((retVal = rtl8367c_setAsicReg(RTL8367C_REG_PTP_TIME_SEC_H_SEC, sec_h)) != RT_ERR_OK)
        return retVal;
    if ((retVal = rtl8367c_setAsicReg(RTL8367C_REG_PTP_TIME_SEC_L_SEC, sec_l)) != RT_ERR_OK)
        return retVal;
    if ((retVal = rtl8367c_setAsicReg(RTL8367C_REG_PTP_TIME_NSEC_L_NSEC, nsec8_l)) != RT_ERR_OK)
        return retVal;

    if (PTP_TIME_ADJ_INC == type)
        regData = nsec8_h | (PTP_TIME_INC << RTL8367C_PTP_TIME_NSEC_H_CMD_OFFSET) | RTL8367C_PTP_TIME_NSEC_H_EXEC_MASK;
    else
        regData = nsec8_h | (PTP_TIME_DEC << RTL8367C_PTP_TIME_NSEC_H_CMD_OFFSET) | RTL8367C_PTP_TIME_NSEC_H_EXEC_MASK;

    if ((retVal = rtl8367c_setAsicReg(RTL8367C_REG_PTP_TIME_NSEC_H_NSEC, regData)) != RT_ERR_OK)
        return retVal;

    count = 0;
    do
    {
        if ((retVal = rtl8367c_getAsicRegBit(RTL8367C_REG_PTP_TIME_NSEC_H_NSEC, RTL8367C_PTP_TIME_NSEC_H_EXEC_OFFSET, &busyFlag)) != RT_ERR_OK)
            return retVal;
        count++;
    } while ((busyFlag != 0) && (count < 5));

    if (busyFlag != 0)
        return RT_ERR_BUSYWAIT_TIMEOUT;

    return RT_ERR_OK;
}

/* Function Name:
 *      rtl8367c_setAsicEavSysTimeCtrl
 * Description:
 *      Set PTP system time control
 * Input:
 *      command - start or stop
 * Output:
 *      None
 * Return:
 *      RT_ERR_OK     - Success
 *      RT_ERR_SMI  - SMI access error
 * Note:
 *      None
 */
ret_t rtl8367c_setAsicEavSysTimeCtrl(rtk_uint32 control)
{
    ret_t retVal;
    rtk_uint32 regData;

    if (control >= PTP_TIME_CTRL_END)
        return RT_ERR_INPUT;

    regData = 0;
    if (PTP_TIME_CTRL_START == control)
        regData = RTL8367C_CFG_TIMER_EN_FRC_MASK | RTL8367C_CFG_TIMER_1588_EN_MASK;
    else
        regData = 0;

    if ((retVal = rtl8367c_setAsicReg(RTL8367C_REG_PTP_TIME_CFG, regData)) != RT_ERR_OK)
        return retVal;

    return RT_ERR_OK;
}

/* Function Name:
 *      rtl8367c_getAsicEavSysTimeCtrl
 * Description:
 *      Get PTP system time control
 * Input:
 *      None
 * Output:
 *      pControl - start or stop
 * Return:
 *      RT_ERR_OK     - Success
 *      RT_ERR_SMI  - SMI access error
 * Note:
 *      None
 */
ret_t rtl8367c_getAsicEavSysTimeCtrl(rtk_uint32 *pControl)
{
    ret_t retVal;
    rtk_uint32 regData;
    rtk_uint32 mask;

    mask = RTL8367C_CFG_TIMER_EN_FRC_MASK | RTL8367C_CFG_TIMER_1588_EN_MASK;

    if ((retVal = rtl8367c_getAsicReg(RTL8367C_REG_PTP_TIME_CFG, &regData)) != RT_ERR_OK)
        return retVal;

    if ((regData & mask) == mask)
        *pControl = PTP_TIME_CTRL_START;
    else if ((regData & mask) == 0)
        *pControl = PTP_TIME_CTRL_STOP;
    else
        return RT_ERR_NOT_ALLOWED;

    return RT_ERR_OK;
}

/* Function Name:
 *      rtl8367c_setAsicEavInterruptMask
 * Description:
 *      Set PTP interrupt enable mask
 * Input:
 *      imr     - Interrupt mask
 * Output:
 *      None
 * Return:
 *      RT_ERR_OK   - Success
 *      RT_ERR_SMI  - SMI access error
 * Note:
 *      [0]:TX_SYNC,
 *      [1]:TX_DELAY,
 *      [2]:TX_PDELAY_REQ,
 *      [3]:TX_PDELAY_RESP,
 *      [4]:RX_SYNC,
 *      [5]:RX_DELAY,
 *      [6]:RX_PDELAY_REQ,
 *      [7]:RX_PDELAY_RESP,
 */
ret_t rtl8367c_setAsicEavInterruptMask(rtk_uint32 imr)
{
    if ((imr & (RTL8367C_PTP_INTR_MASK << 8)) > 0)
        return RT_ERR_INPUT;

    return rtl8367c_setAsicRegBits(RTL8367C_REG_PTP_TIME_CFG2, RTL8367C_PTP_INTR_MASK, imr);
}
/* Function Name:
 *      rtl8367c_getAsicEavInterruptMask
 * Description:
 *      Get PTP interrupt enable mask
 * Input:
 *      pImr    - Interrupt mask
 * Output:
 *      None
 * Return:
 *      RT_ERR_OK   - Success
 *      RT_ERR_SMI  - SMI access error
 * Note:
 *      [0]:TX_SYNC,
 *      [1]:TX_DELAY,
 *      [2]:TX_PDELAY_REQ,
 *      [3]:TX_PDELAY_RESP,
 *      [4]:RX_SYNC,
 *      [5]:RX_DELAY,
 *      [6]:RX_PDELAY_REQ,
 *      [7]:RX_PDELAY_RESP,
 */
ret_t rtl8367c_getAsicEavInterruptMask(rtk_uint32 *pImr)
{
    return rtl8367c_getAsicRegBits(RTL8367C_REG_PTP_TIME_CFG2, RTL8367C_PTP_INTR_MASK, pImr);
}

/* Function Name:
 *      rtl8367c_getAsicEavInterruptStatus
 * Description:
 *      Get PTP interrupt port status mask
 * Input:
 *      pIms    - Interrupt mask
 * Output:
 *      None
 * Return:
 *      RT_ERR_OK   - Success
 *      RT_ERR_SMI  - SMI access error
 * Note:
 *      [0]:p0 interrupt,
 *      [1]:p1 interrupt,
 *      [2]:p2 interrupt,
 *      [3]:p3 interrupt,
 *      [4]:p4 interrupt,
 */
ret_t rtl8367c_getAsicEavInterruptStatus(rtk_uint32 *pIms)
{
    return rtl8367c_getAsicRegBits(RTL8367C_REG_PTP_INTERRUPT_CFG, RTL8367C_PTP_PORT_MASK, pIms);
}

/* Function Name:
 *      rtl8367c_setAsicInterruptMask
 * Description:
 *      Clear interrupt enable mask
 * Input:
 *      ims     - Interrupt status mask
 * Output:
 *      None
 * Return:
 *      RT_ERR_OK   - Success
 *      RT_ERR_SMI  - SMI access error
 * Note:
 *      This API can be used to clear ASIC interrupt status and register will be cleared by writting 1.
 *      [0]:TX_SYNC,
 *      [1]:TX_DELAY,
 *      [2]:TX_PDELAY_REQ,
 *      [3]:TX_PDELAY_RESP,
 *      [4]:RX_SYNC,
 *      [5]:RX_DELAY,
 *      [6]:RX_PDELAY_REQ,
 *      [7]:RX_PDELAY_RESP,
 */
ret_t rtl8367c_setAsicEavPortInterruptStatus(rtk_uint32 port, rtk_uint32 ims)
{

    if (port > RTL8367C_PORTNO)
        return RT_ERR_PORT_ID;

    if (port < 5)
        return rtl8367c_setAsicRegBits(RTL8367C_EAV_PORT_CFG_REG(port), RTL8367C_PTP_INTR_MASK, ims);
    else if (port == 5)
        return rtl8367c_setAsicRegBits(RTL8367C_REG_P5_EAV_CFG, RTL8367C_PTP_INTR_MASK, ims);
    else if (port == 6)
        return rtl8367c_setAsicRegBits(RTL8367C_REG_P6_EAV_CFG, RTL8367C_PTP_INTR_MASK, ims);
    else if (port == 7)
        return rtl8367c_setAsicRegBits(RTL8367C_REG_P7_EAV_CFG, RTL8367C_PTP_INTR_MASK, ims);
    else if (port == 8)
        return rtl8367c_setAsicRegBits(RTL8367C_REG_P8_EAV_CFG, RTL8367C_PTP_INTR_MASK, ims);
    else if (port == 9)
        return rtl8367c_setAsicRegBits(RTL8367C_REG_P9_EAV_CFG, RTL8367C_PTP_INTR_MASK, ims);

    return RT_ERR_OK;
}
/* Function Name:
 *      rtl8367c_getAsicInterruptStatus
 * Description:
 *      Get interrupt enable mask
 * Input:
 *      pIms    - Interrupt status mask
 * Output:
 *      None
 * Return:
 *      RT_ERR_OK   - Success
 *      RT_ERR_SMI  - SMI access error
 * Note:
 *      [0]:TX_SYNC,
 *      [1]:TX_DELAY,
 *      [2]:TX_PDELAY_REQ,
 *      [3]:TX_PDELAY_RESP,
 *      [4]:RX_SYNC,
 *      [5]:RX_DELAY,
 *      [6]:RX_PDELAY_REQ,
 *      [7]:RX_PDELAY_RESP,
 */
ret_t rtl8367c_getAsicEavPortInterruptStatus(rtk_uint32 port, rtk_uint32 *pIms)
{

    if (port > RTL8367C_PORTNO)
        return RT_ERR_PORT_ID;
    if (port < 5)
        return rtl8367c_getAsicRegBits(RTL8367C_EAV_PORT_CFG_REG(port), RTL8367C_PTP_INTR_MASK, pIms);
    else if (port == 5)
        return rtl8367c_getAsicRegBits(RTL8367C_REG_P5_EAV_CFG, RTL8367C_PTP_INTR_MASK, pIms);
    else if (port == 6)
        return rtl8367c_getAsicRegBits(RTL8367C_REG_P6_EAV_CFG, RTL8367C_PTP_INTR_MASK, pIms);
    else if (port == 7)
        return rtl8367c_getAsicRegBits(RTL8367C_REG_P7_EAV_CFG, RTL8367C_PTP_INTR_MASK, pIms);
    else if (port == 8)
        return rtl8367c_getAsicRegBits(RTL8367C_REG_P8_EAV_CFG, RTL8367C_PTP_INTR_MASK, pIms);
    else if (port == 9)
        return rtl8367c_getAsicRegBits(RTL8367C_REG_P9_EAV_CFG, RTL8367C_PTP_INTR_MASK, pIms);

    return RT_ERR_OK;
}

/* Function Name:
 *      rtl8367c_setAsicEavPortEnable
 * Description:
 *      Set per-port EAV function enable/disable
 * Input:
 *      port         - Physical port number (0~9)
 *      enabled     - 1: enabled, 0: disabled
 * Output:
 *      None
 * Return:
 *      RT_ERR_OK         - Success
 *      RT_ERR_SMI      - SMI access error
 *      RT_ERR_PORT_ID  - Invalid port number
 * Note:
 *      If EAV function is enabled, PTP event messgae packet will be attached PTP timestamp for trapping
 */
ret_t rtl8367c_setAsicEavPortEnable(rtk_uint32 port, rtk_uint32 enabled)
{
    if (port > RTL8367C_PORTNO)
        return RT_ERR_PORT_ID;

    if (port < 5)
        return rtl8367c_setAsicRegBit(RTL8367C_EAV_PORT_CFG_REG(port), RTL8367C_EAV_CFG_PTP_PHY_EN_EN_OFFSET, enabled);
    else if (port == 5)
        return rtl8367c_setAsicRegBit(RTL8367C_REG_P5_EAV_CFG, RTL8367C_EAV_CFG_PTP_PHY_EN_EN_OFFSET, enabled);
    else if (port == 6)
        return rtl8367c_setAsicRegBit(RTL8367C_REG_P6_EAV_CFG, RTL8367C_EAV_CFG_PTP_PHY_EN_EN_OFFSET, enabled);
    else if (port == 7)
        return rtl8367c_setAsicRegBit(RTL8367C_REG_P7_EAV_CFG, RTL8367C_EAV_CFG_PTP_PHY_EN_EN_OFFSET, enabled);
    else if (port == 8)
        return rtl8367c_setAsicRegBit(RTL8367C_REG_P8_EAV_CFG, RTL8367C_EAV_CFG_PTP_PHY_EN_EN_OFFSET, enabled);
    else if (port == 9)
        return rtl8367c_setAsicRegBit(RTL8367C_REG_P9_EAV_CFG, RTL8367C_EAV_CFG_PTP_PHY_EN_EN_OFFSET, enabled);

    return RT_ERR_OK;
}
/* Function Name:
 *      rtl8367c_getAsicEavPortEnable
 * Description:
 *      Get per-port EAV function enable/disable
 * Input:
 *      port         - Physical port number (0~9)
 *      pEnabled     - 1: enabled, 0: disabled
 * Output:
 *      None
 * Return:
 *      RT_ERR_OK         - Success
 *      RT_ERR_SMI      - SMI access error
 *      RT_ERR_PORT_ID  - Invalid port number
 * Note:
 *      None
 */
ret_t rtl8367c_getAsicEavPortEnable(rtk_uint32 port, rtk_uint32 *pEnabled)
{
    if (port > RTL8367C_PORTNO)
        return RT_ERR_PORT_ID;

    if (port < 5)
        return rtl8367c_getAsicRegBit(RTL8367C_EAV_PORT_CFG_REG(port), RTL8367C_EAV_CFG_PTP_PHY_EN_EN_OFFSET, pEnabled);
    else if (port == 5)
        return rtl8367c_getAsicRegBit(RTL8367C_REG_P5_EAV_CFG, RTL8367C_EAV_CFG_PTP_PHY_EN_EN_OFFSET, pEnabled);
    else if (port == 6)
        return rtl8367c_getAsicRegBit(RTL8367C_REG_P6_EAV_CFG, RTL8367C_EAV_CFG_PTP_PHY_EN_EN_OFFSET, pEnabled);
    else if (port == 7)
        return rtl8367c_getAsicRegBit(RTL8367C_REG_P7_EAV_CFG, RTL8367C_EAV_CFG_PTP_PHY_EN_EN_OFFSET, pEnabled);
    else if (port == 8)
        return rtl8367c_getAsicRegBit(RTL8367C_REG_P8_EAV_CFG, RTL8367C_EAV_CFG_PTP_PHY_EN_EN_OFFSET, pEnabled);
    else if (port == 9)
        return rtl8367c_getAsicRegBit(RTL8367C_REG_P9_EAV_CFG, RTL8367C_EAV_CFG_PTP_PHY_EN_EN_OFFSET, pEnabled);

    return RT_ERR_OK;
}

/* Function Name:
 *      rtl8367c_getAsicEavPortTimeStamp
 * Description:
 *      Get PTP port time stamp
 * Input:
 *      port         - Physical port number (0~9)
 *      type     -  PTP packet type
 * Output:
 *      timeStamp - seconds
 * Return:
 *      RT_ERR_OK     - Success
 *      RT_ERR_SMI  - SMI access error
 * Note:
 *      The time granuality is 8 nano seconds.
 */
ret_t rtl8367c_getAsicEavPortTimeStamp(rtk_uint32 port, rtk_uint32 type, rtl8367c_ptp_time_stamp_t *timeStamp)
{
    ret_t retVal;
    rtk_uint32 sec_h, sec_l, nsec8_h, nsec8_l;
    rtk_uint32 nano_second_8;

    if (port > 9)
        return RT_ERR_PORT_ID;
    if (type >= PTP_PKT_TYPE_END)
        return RT_ERR_INPUT;

    if (port < 5)
    {
        if ((retVal = rtl8367c_getAsicReg(RTL8367C_REG_SEQ_ID(port, type), &timeStamp->sequence_id)) != RT_ERR_OK)
            return retVal;
        if ((retVal = rtl8367c_getAsicReg(RTL8367C_REG_PORT_SEC_H(port), &sec_h)) != RT_ERR_OK)
            return retVal;
        if ((retVal = rtl8367c_getAsicReg(RTL8367C_REG_PORT_SEC_L(port), &sec_l)) != RT_ERR_OK)
            return retVal;
        if ((retVal = rtl8367c_getAsicRegBits(RTL8367C_REG_PORT_NSEC_H(port), RTL8367C_PORT_NSEC_H_MASK, &nsec8_h)) != RT_ERR_OK)
            return retVal;
        if ((retVal = rtl8367c_getAsicReg(RTL8367C_REG_PORT_NSEC_L(port), &nsec8_l)) != RT_ERR_OK)
            return retVal;
    }
    else if (port == 5)
    {
        if ((retVal = rtl8367c_getAsicReg(RTL8367C_REG_P5_TX_SYNC_SEQ_ID + type, &timeStamp->sequence_id)) != RT_ERR_OK)
            return retVal;
        if ((retVal = rtl8367c_getAsicReg(RTL8367C_REG_P5_PORT_SEC_31_16, &sec_h)) != RT_ERR_OK)
            return retVal;
        if ((retVal = rtl8367c_getAsicReg(RTL8367C_REG_P5_PORT_SEC_15_0, &sec_l)) != RT_ERR_OK)
            return retVal;
        if ((retVal = rtl8367c_getAsicRegBits(RTL8367C_REG_P5_PORT_NSEC_26_16, RTL8367C_PORT_NSEC_H_MASK, &nsec8_h)) != RT_ERR_OK)
            return retVal;
        if ((retVal = rtl8367c_getAsicReg(RTL8367C_REG_P5_PORT_NSEC_15_0, &nsec8_l)) != RT_ERR_OK)
            return retVal;
    }
    else if (port == 6)
    {
        if ((retVal = rtl8367c_getAsicReg(RTL8367C_REG_P6_TX_SYNC_SEQ_ID + type, &timeStamp->sequence_id)) != RT_ERR_OK)
            return retVal;
        if ((retVal = rtl8367c_getAsicReg(RTL8367C_REG_P6_PORT_SEC_31_16, &sec_h)) != RT_ERR_OK)
            return retVal;
        if ((retVal = rtl8367c_getAsicReg(RTL8367C_REG_P6_PORT_SEC_15_0, &sec_l)) != RT_ERR_OK)
            return retVal;
        if ((retVal = rtl8367c_getAsicRegBits(RTL8367C_REG_P6_PORT_NSEC_26_16, RTL8367C_PORT_NSEC_H_MASK, &nsec8_h)) != RT_ERR_OK)
            return retVal;
        if ((retVal = rtl8367c_getAsicReg(RTL8367C_REG_P6_PORT_NSEC_15_0, &nsec8_l)) != RT_ERR_OK)
            return retVal;
    }
    else if (port == 7)
    {
        if ((retVal = rtl8367c_getAsicReg(RTL8367C_REG_P7_TX_SYNC_SEQ_ID + type, &timeStamp->sequence_id)) != RT_ERR_OK)
            return retVal;
        if ((retVal = rtl8367c_getAsicReg(RTL8367C_REG_P7_PORT_SEC_31_16, &sec_h)) != RT_ERR_OK)
            return retVal;
        if ((retVal = rtl8367c_getAsicReg(RTL8367C_REG_P7_PORT_SEC_15_0, &sec_l)) != RT_ERR_OK)
            return retVal;
        if ((retVal = rtl8367c_getAsicRegBits(RTL8367C_REG_P7_PORT_NSEC_26_16, RTL8367C_PORT_NSEC_H_MASK, &nsec8_h)) != RT_ERR_OK)
            return retVal;
        if ((retVal = rtl8367c_getAsicReg(RTL8367C_REG_P7_PORT_NSEC_15_0, &nsec8_l)) != RT_ERR_OK)
            return retVal;
    }
    else if (port == 8)
    {
        if ((retVal = rtl8367c_getAsicReg(RTL8367C_REG_P8_TX_SYNC_SEQ_ID + type, &timeStamp->sequence_id)) != RT_ERR_OK)
            return retVal;
        if ((retVal = rtl8367c_getAsicReg(RTL8367C_REG_P8_PORT_SEC_31_16, &sec_h)) != RT_ERR_OK)
            return retVal;
        if ((retVal = rtl8367c_getAsicReg(RTL8367C_REG_P8_PORT_SEC_15_0, &sec_l)) != RT_ERR_OK)
            return retVal;
        if ((retVal = rtl8367c_getAsicRegBits(RTL8367C_REG_P8_PORT_NSEC_26_16, RTL8367C_PORT_NSEC_H_MASK, &nsec8_h)) != RT_ERR_OK)
            return retVal;
        if ((retVal = rtl8367c_getAsicReg(RTL8367C_REG_P8_PORT_NSEC_15_0, &nsec8_l)) != RT_ERR_OK)
            return retVal;
    }
    else if (port == 9)
    {
        if ((retVal = rtl8367c_getAsicReg(RTL8367C_REG_P9_TX_SYNC_SEQ_ID + type, &timeStamp->sequence_id)) != RT_ERR_OK)
            return retVal;
        if ((retVal = rtl8367c_getAsicReg(RTL8367C_REG_P9_PORT_SEC_31_16, &sec_h)) != RT_ERR_OK)
            return retVal;
        if ((retVal = rtl8367c_getAsicReg(RTL8367C_REG_P9_PORT_SEC_15_0, &sec_l)) != RT_ERR_OK)
            return retVal;
        if ((retVal = rtl8367c_getAsicRegBits(RTL8367C_REG_P9_PORT_NSEC_26_16, RTL8367C_PORT_NSEC_H_MASK, &nsec8_h)) != RT_ERR_OK)
            return retVal;
        if ((retVal = rtl8367c_getAsicReg(RTL8367C_REG_P9_PORT_NSEC_15_0, &nsec8_l)) != RT_ERR_OK)
            return retVal;
    }

    timeStamp->second = (sec_h << 16) | sec_l;
    nano_second_8 = (nsec8_h << 16) | nsec8_l;
    timeStamp->nano_second = nano_second_8 << 3;

    return RT_ERR_OK;
}

/* Function Name:
 *      rtl8367c_setAsicEavTrap
 * Description:
 *      Set per-port PTP packet trap to CPU
 * Input:
 *      port         - Physical port number (0~5)
 *      enabled     - 1: enabled, 0: disabled
 * Output:
 *      None
 * Return:
 *      RT_ERR_OK         - Success
 *      RT_ERR_SMI      - SMI access error
 *      RT_ERR_PORT_ID  - Invalid port number
 * Note:
 *      If EAV trap enabled, switch will trap PTP packet to CPU
 */
ret_t rtl8367c_setAsicEavTrap(rtk_uint32 port, rtk_uint32 enabled)
{
    if (port > RTL8367C_PORTNO)
        return RT_ERR_PORT_ID;

    return rtl8367c_setAsicRegBit(RTL8367C_REG_PTP_PORT0_CFG1 + (port * 0x20), RTL8367C_PTP_PORT0_CFG1_OFFSET, enabled);
}
/* Function Name:
 *      rtl8367c_getAsicEavTimeSyncEn
 * Description:
 *      Get per-port EPTP packet trap to CPU
 * Input:
 *      port         - Physical port number (0~5)
 *      pEnabled     - 1: enabled, 0: disabled
 * Output:
 *      None
 * Return:
 *      RT_ERR_OK         - Success
 *      RT_ERR_SMI      - SMI access error
 *      RT_ERR_PORT_ID  - Invalid port number
 * Note:
 *      None
 */
ret_t rtl8367c_getAsicEavTrap(rtk_uint32 port, rtk_uint32 *pEnabled)
{
    if (port > RTL8367C_PORTNO)
        return RT_ERR_PORT_ID;

    return rtl8367c_getAsicRegBit(RTL8367C_REG_PTP_PORT0_CFG1 + (port * 0x20), RTL8367C_PTP_PORT0_CFG1_OFFSET, pEnabled);
}

/* Function Name:
 *      rtl8367c_setAsicEavEnable
 * Description:
 *      Set per-port EAV function enable/disable
 * Input:
 *      port         - Physical port number (0~5)
 *      enabled     - 1: enabled, 0: disabled
 * Output:
 *      None
 * Return:
 *      RT_ERR_OK         - Success
 *      RT_ERR_SMI      - SMI access error
 *      RT_ERR_PORT_ID  - Invalid port number
 * Note:
 *      If EAV function is enabled, PTP event messgae packet will be attached PTP timestamp for trapping
 */
ret_t rtl8367c_setAsicEavEnable(rtk_uint32 port, rtk_uint32 enabled)
{
    if (port > RTL8367C_PORTNO)
        return RT_ERR_PORT_ID;

    return rtl8367c_setAsicRegBit(RTL8367C_REG_EAV_CTRL0, port, enabled);
}
/* Function Name:
 *      rtl8367c_getAsicEavEnable
 * Description:
 *      Get per-port EAV function enable/disable
 * Input:
 *      port         - Physical port number (0~5)
 *      pEnabled     - 1: enabled, 0: disabled
 * Output:
 *      None
 * Return:
 *      RT_ERR_OK         - Success
 *      RT_ERR_SMI      - SMI access error
 *      RT_ERR_PORT_ID  - Invalid port number
 * Note:
 *      None
 */
ret_t rtl8367c_getAsicEavEnable(rtk_uint32 port, rtk_uint32 *pEnabled)
{
    if (port > RTL8367C_PORTNO)
        return RT_ERR_PORT_ID;

    return rtl8367c_getAsicRegBit(RTL8367C_REG_EAV_CTRL0, port, pEnabled);
}
/* Function Name:
 *      rtl8367c_setAsicEavPriRemapping
 * Description:
 *      Set non-EAV streaming priority remapping
 * Input:
 *      srcpriority - Priority value
 *      priority     - Absolute priority value
 * Output:
 *      None
 * Return:
 *      RT_ERR_OK                     - Success
 *      RT_ERR_SMI                  - SMI access error
 *      RT_ERR_QOS_INT_PRIORITY      - Invalid priority
 * Note:
 *      None
 */
ret_t rtl8367c_setAsicEavPriRemapping(rtk_uint32 srcpriority, rtk_uint32 priority)
{
    if (srcpriority > RTL8367C_PRIMAX || priority > RTL8367C_PRIMAX)
        return RT_ERR_QOS_INT_PRIORITY;

    return rtl8367c_setAsicRegBits(RTL8367C_EAV_PRIORITY_REMAPPING_REG(srcpriority), RTL8367C_EAV_PRIORITY_REMAPPING_MASK(srcpriority), priority);
}
/* Function Name:
 *      rtl8367c_getAsicEavPriRemapping
 * Description:
 *      Get non-EAV streaming priority remapping
 * Input:
 *      srcpriority - Priority value
 *      pPriority     - Absolute priority value
 * Output:
 *      None
 * Return:
 *      RT_ERR_OK                     - Success
 *      RT_ERR_SMI                  - SMI access error
 *      RT_ERR_QOS_INT_PRIORITY      - Invalid priority
 * Note:
 *      None
 */
ret_t rtl8367c_getAsicEavPriRemapping(rtk_uint32 srcpriority, rtk_uint32 *pPriority)
{
    if (srcpriority > RTL8367C_PRIMAX)
        return RT_ERR_QOS_INT_PRIORITY;

    return rtl8367c_getAsicRegBits(RTL8367C_EAV_PRIORITY_REMAPPING_REG(srcpriority), RTL8367C_EAV_PRIORITY_REMAPPING_MASK(srcpriority), pPriority);
}