/*****************************************************************************
* 函 数 名 : BSP_IPF_ConfigUpFilter
*
* 功能描述 : IPF上行IP过滤函数
*
* 输入参数 : unsigned int u32Num, IPF_CONFIG_ULPARAM_S* pstUlPara, BSP_BOOL bintFlag
* 输出参数 : 无
* 返 回 值 : IPF_SUCCESS 配置成功
* IPF_ERROR 配置失败
* BSP_ERR_IPF_NOT_INIT 模块未初始化
* BSP_ERR_IPF_INVALID_PARA 参数错误
*
* 修改记录 :2011年11月30日 鲁婷 创建
* 1.修改日期 : 2012年11月29日
* 修改作者 : z00212992
* 修改记录 : 增加IPF备份恢复机制修改
*****************************************************************************/
int BSP_IPF_ConfigUpFilter(unsigned int u32Num, IPF_CONFIG_ULPARAM_S* pstUlPara)
{
unsigned int i = 0;
unsigned int u32BdqWptr = 0;
IPF_CONFIG_ULPARAM_S* pstUlParam = pstUlPara;
#ifdef __BSP_IPF_DEBUG__
SOC_IPF_CH0_ADQ_CTRL_UNION unCh0AdqCtrl;
#endif
/*Modify_for_c_reset, l00212112,20130511, starts*/
/*如果C核复位，则返回*/
if (IPF_FORRESET_CONTROL_FORBID == IPF_GetControlFLagForCcoreReset())
{
IPF_PRINT_ERROR("ccore is resetting\n");
return BSP_ERR_IPF_CCORE_RESETTING;
}
/*Modify_for_c_reset, l00212112,20130511, ends*/
/* 参数检查 */
if((NULL == pstUlPara))
{
IPF_PRINT_ERROR("point is null\n");
return BSP_ERR_IPF_INVALID_PARA;
}
/* 检查模块是否初始化 */
IPF_INIT_CHECK();
if(u32Num > *(g_stIpfUl.pu32IdleBd))
{
#ifdef __BSP_IPF_DEBUG__
g_stIPFDebugInfo->u32UlBdNotEnough++;
#endif
return IPF_ERROR;
}
#ifdef __BSP_IPF_DEBUG__
IPF_REG_READ(SOC_IPF_CH0_ADQ_CTRL_ADDR(IPF_REGBASE_ADR), unCh0AdqCtrl.value);
if(unCh0AdqCtrl.reg.ul_adq_en != IPF_BOTH_ADQ_EN)
{
IPF_PRINT_ERROR("adq is not supported\n");
return IPF_ERROR;
}
g_stIPFDebugInfo->u32UlBdNum += u32Num;
#endif
/* 确保IPF已恢复 */
if(IPF_ERROR == IPF_WaitResume())
{
IPF_PRINT_ERROR("wait for resume timeout\n");
g_stIPFDebugInfo->u32UlResumeTimeoutCnt++;
return BSP_ERR_IPF_RESUME_TIMEOUT;
}
/* 读出BD写指针,将u32BdqWptr作为临时写指针使用 */
IPF_REG_READ(SOC_IPF_CH0_BDQ_WPTR_ADDR(IPF_REGBASE_ADR), u32BdqWptr);
for(i = 0; i < u32Num; i++)
{
if(0 == pstUlParam[i].u32Data)
{
IPF_PRINT_ERROR("ulbd inptr is null\n");
return BSP_ERR_IPF_INVALID_PARA;
}
if(0 == pstUlParam[i].u16Len)
{
IPF_PRINT_ERROR("ulbd len is zero\n");
g_stIPFDebugInfo->u32UlBdSizeErr = 1;
return BSP_ERR_IPF_INVALID_PARA;
}
g_stIpfUl.pstIpfBDQ[u32BdqWptr].u16Attribute = pstUlParam[i].u16Attribute;
g_stIpfUl.pstIpfBDQ[u32BdqWptr].u32InPtr = pstUlParam[i].u32Data;
g_stIpfUl.pstIpfBDQ[u32BdqWptr].u16PktLen = pstUlParam[i].u16Len;
g_stIpfUl.pstIpfBDQ[u32BdqWptr].u16UsrField1 = pstUlParam[i].u16UsrField1;
g_stIpfUl.pstIpfBDQ[u32BdqWptr].u32UsrField2= pstUlParam[i].u32UsrField2;
g_stIpfUl.pstIpfBDQ[u32BdqWptr].u32UsrField3 = pstUlParam[i].u32UsrField3;
u32BdqWptr = ((u32BdqWptr + 1) < IPF_ULBD_DESC_SIZE)? (u32BdqWptr + 1) : 0;
}
/* 更新BD写指针*/
IPF_REG_WRITE(SOC_IPF_CH0_BDQ_WPTR_ADDR(IPF_REGBASE_ADR), u32BdqWptr);
return IPF_SUCCESS;
}
BSP_S32 BSP_IPF_CHInfo(IPF_CHANNEL_TYPE_E eChnType)
{
BSP_U32 u32ChanCtrlInfo = 0;
BSP_U32 u32ChanStateInfo = 0;
BSP_U32 u32BdqBaseAddr = 0;
BSP_U32 u32BdqDepth = 0;
BSP_U32 u32BdqWptr = 0;
BSP_U32 u32BdqRptr = 0;
BSP_U32 u32BdqWaddr = 0;
BSP_U32 u32BdqRaddr = 0;
BSP_U32 u32RdqBaseAddr = 0;
BSP_U32 u32RdqDepth = 0;
BSP_U32 u32RdqRptr = 0;
BSP_U32 u32RdqWptr = 0;
BSP_U32 u32RdqWaddr = 0;
BSP_U32 u32RdqRaddr = 0;
BSP_U32 u32Depth = 0;
BSP_U32 u32AdqCtrlInfo = 0;
BSP_U32 u32Adq0BaseAddr = 0;
BSP_U32 u32Adq0StateInfo = 0;
BSP_U32 u32Adq0Wptr = 0;
BSP_U32 u32Adq0Rptr = 0;
BSP_U32 u32Adq1BaseAddr = 0;
BSP_U32 u32Adq1StateInfo = 0;
BSP_U32 u32Adq1Wptr = 0;
BSP_U32 u32Adq1Rptr = 0;
switch (eChnType) {
case IPF_CHANNEL_UP:
IPF_REG_READ(SOC_IPF_CH0_CTRL_ADDR(IPF_REGBASE_ADR), u32ChanCtrlInfo);
IPF_REG_READ(SOC_IPF_CH0_STATE_ADDR(IPF_REGBASE_ADR), u32ChanStateInfo);
IPF_REG_READ(SOC_IPF_CH0_BDQ_BADDR_ADDR(IPF_REGBASE_ADR), u32BdqBaseAddr);
IPF_REG_READ(SOC_IPF_CH0_BDQ_SIZE_ADDR(IPF_REGBASE_ADR), u32BdqDepth);
IPF_REG_READ(SOC_IPF_CH0_BDQ_WPTR_ADDR(IPF_REGBASE_ADR), u32BdqWptr);
IPF_REG_READ(SOC_IPF_CH0_BDQ_RPTR_ADDR(IPF_REGBASE_ADR), u32BdqRptr);
IPF_REG_READ(SOC_IPF_CH0_BDQ_WADDR_ADDR(IPF_REGBASE_ADR), u32BdqWaddr);
IPF_REG_READ(SOC_IPF_CH0_BDQ_RADDR_ADDR(IPF_REGBASE_ADR), u32BdqRaddr);
IPF_REG_READ(SOC_IPF_CH0_RDQ_BADDR_ADDR(IPF_REGBASE_ADR), u32RdqBaseAddr);
IPF_REG_READ(SOC_IPF_CH0_RDQ_SIZE_ADDR(IPF_REGBASE_ADR), u32RdqDepth);
IPF_REG_READ(SOC_IPF_CH0_RDQ_RPTR_ADDR(IPF_REGBASE_ADR), u32RdqRptr);
IPF_REG_READ(SOC_IPF_CH0_RDQ_WPTR_ADDR(IPF_REGBASE_ADR), u32RdqWptr);
IPF_REG_READ(SOC_IPF_CH0_RDQ_WADDR_ADDR(IPF_REGBASE_ADR), u32RdqWaddr);
IPF_REG_READ(SOC_IPF_CH0_RDQ_RADDR_ADDR(IPF_REGBASE_ADR), u32RdqRaddr);
IPF_REG_READ(SOC_IPF_CH0_DQ_DEPTH_ADDR(IPF_REGBASE_ADR), u32Depth);
IPF_REG_READ(SOC_IPF_CH0_ADQ_CTRL_ADDR(IPF_REGBASE_ADR), u32AdqCtrlInfo);
IPF_REG_READ(SOC_IPF_CH0_ADQ0_BASE_ADDR(IPF_REGBASE_ADR), u32Adq0BaseAddr);
IPF_REG_READ(SOC_IPF_CH0_ADQ0_STAT_ADDR(IPF_REGBASE_ADR), u32Adq0StateInfo);
IPF_REG_READ(SOC_IPF_CH0_ADQ0_WPTR_ADDR(IPF_REGBASE_ADR), u32Adq0Wptr);
IPF_REG_READ(SOC_IPF_CH0_ADQ0_RPTR_ADDR(IPF_REGBASE_ADR), u32Adq0Rptr);
IPF_REG_READ(SOC_IPF_CH0_ADQ1_BASE_ADDR(IPF_REGBASE_ADR), u32Adq1BaseAddr);
IPF_REG_READ(SOC_IPF_CH0_ADQ1_STAT_ADDR(IPF_REGBASE_ADR), u32Adq1StateInfo);
IPF_REG_READ(SOC_IPF_CH0_ADQ1_WPTR_ADDR(IPF_REGBASE_ADR), u32Adq1Wptr);
IPF_REG_READ(SOC_IPF_CH0_ADQ1_RPTR_ADDR(IPF_REGBASE_ADR), u32Adq1Rptr);
break;
case IPF_CHANNEL_DOWN:
IPF_REG_READ(SOC_IPF_CH1_CTRL_ADDR(IPF_REGBASE_ADR), u32ChanCtrlInfo);
IPF_REG_READ(SOC_IPF_CH1_STATE_ADDR(IPF_REGBASE_ADR), u32ChanStateInfo);
IPF_REG_READ(SOC_IPF_CH1_BDQ_BADDR_ADDR(IPF_REGBASE_ADR), u32BdqBaseAddr);
IPF_REG_READ(SOC_IPF_CH1_BDQ_SIZE_ADDR(IPF_REGBASE_ADR), u32BdqDepth);
IPF_REG_READ(SOC_IPF_CH1_BDQ_WPTR_ADDR(IPF_REGBASE_ADR), u32BdqWptr);
IPF_REG_READ(SOC_IPF_CH1_BDQ_RPTR_ADDR(IPF_REGBASE_ADR), u32BdqRptr);
IPF_REG_READ(SOC_IPF_CH1_BDQ_WADDR_ADDR(IPF_REGBASE_ADR), u32BdqWaddr);
IPF_REG_READ(SOC_IPF_CH1_BDQ_RADDR_ADDR(IPF_REGBASE_ADR), u32BdqRaddr);
IPF_REG_READ(SOC_IPF_CH1_RDQ_BADDR_ADDR(IPF_REGBASE_ADR), u32RdqBaseAddr);
IPF_REG_READ(SOC_IPF_CH1_RDQ_SIZE_ADDR(IPF_REGBASE_ADR), u32RdqDepth);
IPF_REG_READ(SOC_IPF_CH1_RDQ_RPTR_ADDR(IPF_REGBASE_ADR), u32RdqRptr);
IPF_REG_READ(SOC_IPF_CH1_RDQ_WPTR_ADDR(IPF_REGBASE_ADR), u32RdqWptr);
IPF_REG_READ(SOC_IPF_CH1_RDQ_WADDR_ADDR(IPF_REGBASE_ADR), u32RdqWaddr);
IPF_REG_READ(SOC_IPF_CH1_RDQ_RADDR_ADDR(IPF_REGBASE_ADR), u32RdqRaddr);
IPF_REG_READ(SOC_IPF_CH1_DQ_DEPTH_ADDR(IPF_REGBASE_ADR), u32Depth);
IPF_REG_READ(SOC_IPF_CH1_ADQ_CTRL_ADDR(IPF_REGBASE_ADR), u32AdqCtrlInfo);
IPF_REG_READ(SOC_IPF_CH1_ADQ0_BASE_ADDR(IPF_REGBASE_ADR), u32Adq0BaseAddr);
IPF_REG_READ(SOC_IPF_CH1_ADQ0_STAT_ADDR(IPF_REGBASE_ADR), u32Adq0StateInfo);
IPF_REG_READ(SOC_IPF_CH1_ADQ0_WPTR_ADDR(IPF_REGBASE_ADR), u32Adq0Wptr);
IPF_REG_READ(SOC_IPF_CH1_ADQ0_RPTR_ADDR(IPF_REGBASE_ADR), u32Adq0Rptr);
IPF_REG_READ(SOC_IPF_CH1_ADQ1_BASE_ADDR(IPF_REGBASE_ADR), u32Adq1BaseAddr);
IPF_REG_READ(SOC_IPF_CH1_ADQ1_STAT_ADDR(IPF_REGBASE_ADR), u32Adq1StateInfo);
IPF_REG_READ(SOC_IPF_CH1_ADQ1_WPTR_ADDR(IPF_REGBASE_ADR), u32Adq1Wptr);
IPF_REG_READ(SOC_IPF_CH1_ADQ1_RPTR_ADDR(IPF_REGBASE_ADR), u32Adq1Rptr);
break;
default:
IPF_PRINT("invalidable channel type \n");
break;
}
IPF_PRINT("============BEGIN===========\n");
IPF_PRINT("通道控制寄存器: 0x%x\n", u32ChanCtrlInfo);
IPF_PRINT("通道状态寄存器: 0x%x\n", u32ChanStateInfo);
IPF_PRINT("BD 基地址: 0x%x\n", u32BdqBaseAddr);
IPF_PRINT("BD 深度: 0x%x\n", u32BdqDepth);
IPF_PRINT("BD 写指针: 0x%x\n", u32BdqWptr);
IPF_PRINT("BD 读指针: 0x%x\n", u32BdqRptr);
IPF_PRINT("BD 写地址: 0x%x\n", u32BdqWaddr);
IPF_PRINT("BD 读地址: 0x%x\n", u32BdqRaddr);
IPF_PRINT("RD 基地址: 0x%x\n", u32RdqBaseAddr);
IPF_PRINT("RD 深度: 0x%x\n", u32RdqDepth);
IPF_PRINT("RD 读指针: 0x%x\n", u32RdqRptr);
IPF_PRINT("RD 写指针: 0x%x\n", u32RdqWptr);
IPF_PRINT("RD 读地址: 0x%x\n", u32RdqRaddr);
IPF_PRINT("RD 写地址: 0x%x\n", u32RdqWaddr);
IPF_PRINT("通道深度寄存器: 0x%x\n", u32Depth);
IPF_PRINT("ADQ控制寄存器: 0x%x\n", u32AdqCtrlInfo);
IPF_PRINT("ADQ0 基地址: 0x%x\n", u32Adq0BaseAddr);
IPF_PRINT("ADQ0 状态寄存器: 0x%x\n", u32Adq0StateInfo);
IPF_PRINT("ADQ0 写指针: 0x%x\n", u32Adq0Wptr);
IPF_PRINT("ADQ0 读指针: 0x%x\n", u32Adq0Rptr);
IPF_PRINT("ADQ1 基地址: 0x%x\n", u32Adq1BaseAddr);
IPF_PRINT("ADQ1 状态寄存器: 0x%x\n", u32Adq1StateInfo);
IPF_PRINT("ADQ1 写指针: 0x%x\n", u32Adq1Wptr);
IPF_PRINT("ADQ1 读指针: 0x%x\n", u32Adq1Rptr);
IPF_PRINT("=============END============\n");
return 0;
}
