static void ipf_drx_restore_adq_rptr(void)
{
#ifndef CONFIG_IPF_AD_RPRT_FIX
u32 u32AdStateValue = 0;
#endif
u32 u32Index = 0;
u32 u32RptrValue = 0;
u32 u32RptrOffsetValue = 0;
u32 u32AdqRptrMaxNum[4] = {IPF_ULAD0_DESC_SIZE,
IPF_ULAD1_DESC_SIZE,
IPF_DLAD0_DESC_SIZE,
IPF_DLAD1_DESC_SIZE};
u32 u32ADCtrl[IPF_CHANNEL_MAX] = {IPF_ADQ_OFF,IPF_ADQ_OFF};
/*写入ADQ长度但不使能ADQ通道，用于防止产生ADQ中断*/
ipf_writel(u32ADCtrl[IPF_CHANNEL_UP], HI_IPF_REGBASE_ADDR_VIRT + HI_IPF_CH0_ADQ_CTRL_OFFSET);
ipf_writel(u32ADCtrl[IPF_CHANNEL_DOWN], HI_IPF_REGBASE_ADDR_VIRT + HI_IPF_CH1_ADQ_CTRL_OFFSET);
for(u32Index = 0; u32Index < 4; u32Index++)
{
u32RptrValue = g_u32_ipf_adq_rptr_bak_addr[u32Index];
#ifndef CONFIG_IPF_AD_RPRT_FIX
u32AdStateValue = g_u32_ipf_adq_rptr_bak_addr[u32Index+4];
/* 根据读取的状态寄存器/读指针寄存器值重新计算Rptr*/
if(u32AdStateValue & IPF_ADQ_BUF_EPT_MASK)
{
u32RptrOffsetValue = 0;
}
else if(u32AdStateValue & IPF_ADQ_BUF_FULL_MASK)
{
u32RptrOffsetValue = 2;
}
else
{
u32RptrOffsetValue = 1;
}
#endif
if(u32RptrValue >= u32RptrOffsetValue)
{
u32RptrValue = u32RptrValue - u32RptrOffsetValue;
}
else
{
u32RptrValue = u32AdqRptrMaxNum[u32Index] + u32RptrValue - u32RptrOffsetValue;
}
/* 更新ADQ状态寄存器/读指针寄存器 */
ipf_writel(u32RptrValue, HI_IPF_REGBASE_ADDR_VIRT + g_ipf_adq_rptr_table[u32Index]);
}
}
s32 check_filter_restore_status(void)
{
s32 ret;
u32 i,j,k,filter_serial;
IPF_MATCH_INFO_S* hard_filter_info;
u32 *hard_filter_info_addr;
IPF_MATCH_INFO_S* backup_filter_info;
u32* backup_info_addr = NULL;
hard_filter_info = (IPF_MATCH_INFO_S*)malloc(sizeof(IPF_MATCH_INFO_S));
if(NULL == hard_filter_info)
{
bsp_trace(BSP_LOG_LEVEL_ERROR, BSP_MODU_IPF, "\r pstMatchInfo malloc ERROR! \n");
return IPF_ERROR;
}
hard_filter_info_addr = (u32*)hard_filter_info;
for(i=0 ; i < IPF_MODEM_MAX; i++)
{
backup_info_addr = (u32 *)(IPF_PWRCTL_BASIC_FILTER_ADDR + i*sizeof(IPF_MATCH_INFO_S));
backup_filter_info = (IPF_MATCH_INFO_S*)backup_info_addr;
filter_serial = i;
k = 0;
do
{
if(filter_serial < IPF_BF_NUM)
{
ipf_writel(filter_serial, HI_IPF_REGBASE_ADDR_VIRT + HI_BFLT_INDEX_OFFSET);
for(j=0; j<(sizeof(IPF_MATCH_INFO_S)/4); j++)
{
*hard_filter_info_addr = ipf_readl((HI_IPF_REGBASE_ADDR_VIRT+HI_FLT_LOCAL_ADDR0_OFFSET+j*4));
hard_filter_info_addr++;
}
k++;
ret = CmpMatchInfo(backup_filter_info, hard_filter_info);
if(ret != 0)
{
bsp_trace(BSP_LOG_LEVEL_ERROR, BSP_MODU_IPF, "chainNum = %d \n",i);
bsp_trace(BSP_LOG_LEVEL_ERROR, BSP_MODU_IPF, "filterNum = %d \n",filter_serial);
bsp_trace(BSP_LOG_LEVEL_ERROR, BSP_MODU_IPF, "========BACKUPED_FILTER_INFO=======\n");
PrintMatchInfo(backup_filter_info);
bsp_trace(BSP_LOG_LEVEL_ERROR, BSP_MODU_IPF, "========FILTER_ACTUAL_INFO=======\n");
PrintMatchInfo(hard_filter_info);
}
hard_filter_info_addr = (u32*)hard_filter_info;
}
filter_serial = backup_filter_info->unFltChain.Bits.u16NextIndex;
backup_filter_info = (IPF_MATCH_INFO_S*)(IPF_PWRCTL_BASIC_FILTER_ADDR + filter_serial*sizeof(IPF_MATCH_INFO_S));
backup_info_addr = (u32 *)backup_filter_info;
if(k >= IPF_BF_NUM)
{
bsp_trace(BSP_LOG_LEVEL_ERROR, BSP_MODU_IPF, "Filter end error!\n");
return IPF_ERROR;
}
}while(filter_serial != IPF_TAIL_INDEX);
}
return IPF_SUCCESS;
}
/*****************************************************************************
* 函 数 名 : ipf_drx_restore_reg
*
* 功能描述 : 提供的低功耗接口，用于IPF上电恢复
*
* 输入参数 : 无
*
* 输出参数 : 无
* 返 回 值 : 无
*
* 注意:该函数需要在锁中断的情况下调用
* 修改记录 : 2013年4月23日v1.00 chendongyue 创建
*****************************************************************************/
void ipf_drx_restore_reg(void)
{
u32* u32_addr;
u32 i = 0;
u32 u32_total = 0;
u32_addr = (u32*)IPF_PWRCTL_INFO_ADDR;
#ifdef CONFIG_BALONG_MODEM_RESET
if(IPF_FORRESET_CONTROL_ALLOW != g_u32_ipf_ccore_reset_flag)
{
return;
}
#endif
/* 复位IPF */
ipf_writel(1, HI_IPF_REGBASE_ADDR_VIRT + HI_IPF_SRST_OFFSET);
/* 解除复位 */
ipf_writel(0, HI_IPF_REGBASE_ADDR_VIRT + HI_IPF_SRST_OFFSET);
u32_total = sizeof(g_ipf_setting_table)/sizeof(u32);
u32_addr = g_u32_ipf_setting_bak_addr;
for(i=0; i<u32_total; i++)
{
ipf_writel(*u32_addr, (g_ipf_setting_table[i]+HI_IPF_REGBASE_ADDR_VIRT));
u32_addr ++;
}
#if !(defined(BSP_CONFIG_HI3630))
ipf_drx_restore_filter();
#endif
ipf_drx_restore_adq_rptr();
u32_total = sizeof(g_ipf_adq_wptr_chctrl_table)/sizeof(u32);
u32_addr = g_u32_ipf_adq_wptr_chctrl_bak_addr;
for(i=0; i<4; i++)
{
ipf_writel(*u32_addr, (g_ipf_adq_wptr_chctrl_table[i]+HI_IPF_REGBASE_ADDR_VIRT));
u32_addr ++;
}
ipf_writel(((*u32_addr)|=IPF_BOTH_ADQ_EN), (HI_IPF_CH0_ADQ_CTRL_OFFSET + HI_IPF_REGBASE_ADDR_VIRT));
u32_addr ++;
ipf_writel(((*u32_addr)|=IPF_BOTH_ADQ_EN), (HI_IPF_CH1_ADQ_CTRL_OFFSET + HI_IPF_REGBASE_ADDR_VIRT));
u32_addr ++;
for(i=6; i<9; i++)
{
ipf_writel(*u32_addr, (g_ipf_adq_wptr_chctrl_table[i]+HI_IPF_REGBASE_ADDR_VIRT));
u32_addr ++;
}
}
/*****************************************************************************
* 函 数 名 : ipf_drx_restore_filter
*
* 功能描述 : 提供的低功耗接口，用于IPF上电恢复
*
* 输入参数 : 无
*
* 输出参数 : 无
* 返 回 值 : 无
*
* 注意:该函数需要在锁中断的情况下调用
* 修改记录 : 2013年4月23日v1.00 chendongyue 创建
*****************************************************************************/
s32 ipf_drx_restore_filter(void)
{
u32 i,j,k,filter_serial;
IPF_MATCH_INFO_S* pstMatchInfo;
u32 match_info;
u32* match_info_addr = (u32 *)(IPF_PWRCTL_BASIC_FILTER_ADDR);
for(i=0 ; i < IPF_MODEM_MAX; i++)
{
match_info_addr = (u32 *)(IPF_PWRCTL_BASIC_FILTER_ADDR + i*sizeof(IPF_MATCH_INFO_S));
pstMatchInfo = (IPF_MATCH_INFO_S*)match_info_addr;
filter_serial = i;
k = 0;
do
{
if(filter_serial < IPF_BF_NUM)
{
ipf_writel(filter_serial, HI_IPF_REGBASE_ADDR_VIRT + HI_BFLT_INDEX_OFFSET);
for(j=0; j<(sizeof(IPF_MATCH_INFO_S)/4); j++)
{
match_info = *(match_info_addr+j);
ipf_writel((match_info), (HI_IPF_REGBASE_ADDR_VIRT+HI_FLT_LOCAL_ADDR0_OFFSET+j*4));
}
k++;
}
filter_serial = pstMatchInfo->unFltChain.Bits.u16NextIndex;
pstMatchInfo = (IPF_MATCH_INFO_S*)(IPF_PWRCTL_BASIC_FILTER_ADDR + filter_serial*sizeof(IPF_MATCH_INFO_S));
match_info_addr = (u32 *)pstMatchInfo;
if(k >= IPF_BF_NUM)
{
break;
}
}while(filter_serial != IPF_TAIL_INDEX);
}
return IPF_SUCCESS;
}
/*****************************************************************************
* 函 数 名 : ipf_drx_bak_reg
*
* 功能描述 : 提供的低功耗接口，保存IPF相关信息
*
* 输入参数 : 无
*
* 输出参数 : 无
* 返 回 值 : IPF_SUCCESS IPF可以下电，相关信息已经保存
* IPF_ERROR IPF不可以下电
* 注意:该函数需要在锁中断的情况下调用
* 修改记录 : 2013年4月23日v1.00 chendongyue 创建
*****************************************************************************/
s32 ipf_drx_bak_reg(void)
{
u32* u32_addr = NULL;
u32 i = 0;
u32 u32_total = 0;
u32 u32_ul_state = 0;
u32 u32_dl_state = 0;
u32 u32ADCtrl[IPF_CHANNEL_MAX] = {0,0};
#ifdef CONFIG_BALONG_MODEM_RESET
if(IPF_FORRESET_CONTROL_ALLOW != g_u32_ipf_ccore_reset_flag)
{
return IPF_SUCCESS;
}
#endif
/* 判断上行IPF是否空闲 */
u32_ul_state = ipf_readl(HI_IPF_REGBASE_ADDR_VIRT + HI_IPF_CH0_STATE_OFFSET);
if(u32_ul_state != IPF_CHANNEL_STATE_IDLE)
{
return IPF_ERROR;
}
/* 判断下行IPF是否空闲 */
u32_dl_state = ipf_readl(HI_IPF_REGBASE_ADDR_VIRT + HI_IPF_CH1_STATE_OFFSET);
if(u32_dl_state != IPF_CHANNEL_STATE_IDLE)
{
return IPF_ERROR;
}
u32ADCtrl[IPF_CHANNEL_UP] = ipf_readl(HI_IPF_REGBASE_ADDR_VIRT + HI_IPF_CH0_ADQ_CTRL_OFFSET);
u32ADCtrl[IPF_CHANNEL_DOWN] = ipf_readl(HI_IPF_REGBASE_ADDR_VIRT + HI_IPF_CH1_ADQ_CTRL_OFFSET);
u32ADCtrl[IPF_CHANNEL_UP] &= IPF_ADQ_EN_MASK;
u32ADCtrl[IPF_CHANNEL_DOWN] &= IPF_ADQ_EN_MASK;
u32ADCtrl[IPF_CHANNEL_UP] |= (IPF_NO_ADQ);
u32ADCtrl[IPF_CHANNEL_DOWN] |= (IPF_NO_ADQ);
/*关闭ADQ通道，用于防止产生ADQ预取*/
ipf_writel(u32ADCtrl[IPF_CHANNEL_UP], HI_IPF_REGBASE_ADDR_VIRT + HI_IPF_CH0_ADQ_CTRL_OFFSET);
ipf_writel(u32ADCtrl[IPF_CHANNEL_DOWN], HI_IPF_REGBASE_ADDR_VIRT + HI_IPF_CH1_ADQ_CTRL_OFFSET);
/* 保存必要的寄存器 */
u32_total = sizeof(g_ipf_setting_table)/sizeof(u32);
u32_addr = g_u32_ipf_setting_bak_addr;
for(i=0; i<u32_total; i++)
{
*u32_addr = ipf_readl(g_ipf_setting_table[i] + HI_IPF_REGBASE_ADDR_VIRT);
u32_addr ++;
}
u32_total = sizeof(g_ipf_adq_wptr_chctrl_table)/sizeof(u32);
u32_addr = g_u32_ipf_adq_wptr_chctrl_bak_addr;
/* 单独保存ADQ_Wptr寄存器和状态寄存器，该组寄存器需要特殊处理 */
for(i=0; i<u32_total; i++)
{
*u32_addr = ipf_readl(g_ipf_adq_wptr_chctrl_table[i] + HI_IPF_REGBASE_ADDR_VIRT);
u32_addr ++;
}
/*由于上电配置顺序问题，备份剩余的寄存器*/
u32_total = sizeof(g_ipf_adq_rptr_table)/sizeof(u32);
u32_addr = g_u32_ipf_adq_rptr_bak_addr;
/* 单独保存ADQ_Rptr寄存器和状态寄存器，该寄存器需要特殊处理 */
for(i=0; i<u32_total; i++)
{
*u32_addr = ipf_readl(g_ipf_adq_rptr_table[i] + HI_IPF_REGBASE_ADDR_VIRT);
u32_addr ++;
}
return IPF_SUCCESS;
}
