VOS_VOID diag_PortSendDataToSocp(DIAG_PORT_DATA_BUF_STRU * dataNode)
{
VOS_UINT32 ret;
ret = SCM_SendDecoderSrc(DIAG_PORT_GET_DECODE_SRC(dataNode->port), dataNode->dataBuf, dataNode->dataLen);
if(ret)
{
diag_printf("[%s]:SCM_SendDecoderSrc err 0x%x!!!!!!!!\n",__func__,ret);
}
VOS_MemFree(MSP_PID_DIAG_APP_AGENT, dataNode->dataBuf);
VOS_MemFree(MSP_PID_DIAG_APP_AGENT, dataNode);
}
/*****************************************************************************
函 数 名 : diag_PortRdCB
功能描述 :
输入参数 :
输出参数 :
返 回 值 :
调用函数 :
被调函数 :
修改历史 :
1.日 期 : 2012年8月27日
修改内容 : Creat Function
*****************************************************************************/
VOS_VOID diag_PortRdCB(DIAG_PORT_PHY_BEAR_ENUM enPort)
{
ACM_WR_ASYNC_INFO acmInfo;
UDI_HANDLE ulUdiHandle;
VOS_UINT32 ret;
ulUdiHandle = DIAG_PORT_GET_HANDLE(enPort);
if(ulUdiHandle == UDI_INVALID_HANDLE)
{
DIAG_DEBUG_SDM_FUN(EN_DIAG_DEBUG_UDI_READ_END,0,0,1);
diag_printf("[%s]:invalid handle!!!!!!!!\n",__func__);
return;
}
ret = udi_ioctl(ulUdiHandle,UDI_ACM_IOCTL_GET_READ_BUFFER_CB,&acmInfo);
if(ret != ERR_MSP_SUCCESS)
{
DIAG_DEBUG_SDM_FUN(EN_DIAG_DEBUG_UDI_READ_END,ret,0,2);
diag_printf("[%s]:get read buffer callback err 0x%x!!!!!!!!\n",__func__,ret);
return;
}
DIAG_DEBUG_SDM_FUN(EN_DIAG_DEBUG_UDI_READ_START,enPort,acmInfo.u32Size,0);
/* 数据通道不会处理命令请求 */
if((EN_DIAG_USB_BEARER_DIAG_APP == enPort) || (EN_DIAG_HSIC_BEARER_DIAG_APP == enPort))
{
DIAG_DEBUG_SDM_FUN(EN_DIAG_DEBUG_UDI_READ_END,0,enPort,3);
vos_printf("[%s] enPort %d.\n", __FUNCTION__, enPort);
udi_ioctl(ulUdiHandle,UDI_ACM_IOCTL_RETUR_BUFFER_CB,&acmInfo);
return ;
}
if(VOS_TRUE == g_diagPort_ctrl.bFlag)
{
if(0x7e != acmInfo.pBuffer[0])
{
vos_printf("[%s] 1 acmInfo.pBuffer[0] %d.\n", __FUNCTION__, acmInfo.pBuffer[0]);
udi_ioctl(ulUdiHandle,UDI_ACM_IOCTL_RETUR_BUFFER_CB,&acmInfo);
DIAG_DEBUG_SDM_FUN(EN_DIAG_DEBUG_UDI_READ_END,0,0,4);
return ;
}
else
{
vos_printf("[%s] 2 acmInfo.pBuffer[0] %d.\n", __FUNCTION__, acmInfo.pBuffer[0]);
g_diagPort_ctrl.bFlag = VOS_FALSE;
}
}
/* V9R1版本，默认VCOM口上报数据，如果从USB口接收到连接请求，则切换到USB口上报数据 */
diag_LogPortSwitch(DIAG_LOG_PORT_USB);
diag_TraceDebug(acmInfo.pBuffer, acmInfo.u32Size);
ret = SCM_SendDecoderSrc(DIAG_PORT_GET_DECODE_SRC(enPort),acmInfo.pBuffer,acmInfo.u32Size);
if(ret)
{
DIAG_DEBUG_SDM_FUN(EN_DIAG_DEBUG_UDI_READ_END,ret,0,5);
diag_printf("[%s]:SCM_SendDecoderSrc err 0x%x!!!!!!!!\n",__func__,ret);
}
udi_ioctl(ulUdiHandle,UDI_ACM_IOCTL_RETUR_BUFFER_CB,&acmInfo);
return;
}
/*****************************************************************************
函 数 名 : diag_PortRdCB
功能描述 :
输入参数 :
输出参数 :
返 回 值 :
调用函数 :
被调函数 :
修改历史 :
1.日 期 : 2012年8月27日
作 者 : heliping
修改内容 : Creat Function
*****************************************************************************/
VOS_VOID diag_PortRdCB(DIAG_PORT_PHY_BEAR_ENUM enPort)
{
ACM_WR_ASYNC_INFO acmInfo = {};
UDI_HANDLE ulUdiHandle;
VOS_UINT32 ret;
VOS_UINT32 ulDataLen;
VOS_CHAR* pdata;
static VOS_UINT32 ulTotalLen = 0;
#if(FEATURE_SOCP_ON_DEMAND == FEATURE_ON)
DIAG_PORT_DATA_BUF_STRU * dataNode;
#endif
ulUdiHandle = DIAG_PORT_GET_HANDLE(enPort);
if(ulUdiHandle == UDI_INVALID_HANDLE)
{
DIAG_DEBUG_SDM_FUN(EN_DIAG_DEBUG_UDI_READ_END,0,0,1);
diag_printf("[%s]:invalid handle!!!!!!!!\n",__func__);
return;
}
ret = (VOS_UINT32)udi_ioctl(ulUdiHandle,UDI_ACM_IOCTL_GET_READ_BUFFER_CB,&acmInfo);
if(ret != ERR_MSP_SUCCESS)
{
DIAG_DEBUG_SDM_FUN(EN_DIAG_DEBUG_UDI_READ_END,0,0,2);
diag_printf("[%s]:get read buffer callback err 0x%x!!!!!!!!\n",__func__,ret);
return;
}
#if(FEATURE_SOCP_ON_DEMAND == FEATURE_ON)
/*端口切换，丢弃链表中数据*/
if(DIAG_PORT_GET_CONN_PORT() != enPort)
{
for(;;)
{
dataNode = diag_PortGetNodeFromDataBuf();
if(dataNode == NULL)
{
break;
}
VOS_MemFree(MSP_PID_DIAG_APP_AGENT, dataNode->dataBuf);
VOS_MemFree(MSP_PID_DIAG_APP_AGENT, dataNode);
}
}
#endif
ulDataLen = acmInfo.u32Size;
#ifdef FEATURE_UPGRADE_TL
pdata = acmInfo.pBuffer;
#else
pdata = acmInfo.pVirAddr;
#endif
ulTotalLen += ulDataLen;
DIAG_DEBUG_SDM_FUN(EN_DIAG_DEBUG_UDI_READ_START,ulTotalLen,ulDataLen,0);
/*设置当前物理通道及通道连接状态*/
DIAG_PORT_PORT_SWITCH(enPort);
DIAG_PORT_CHAN_STATE_SWITCH(enPort,ACM_EVT_DEV_READY);
DIAG_PORT_CHAN_STATE_SWITCH(enPort+1,ACM_EVT_DEV_READY);
diag_PrintToFile(UsbCtrlRdCB_LogPath, pdata, ulDataLen);
diag_TraceDebug(pdata, ulDataLen);
#if(FEATURE_SOCP_ON_DEMAND == FEATURE_ON)
/*SOCP不可用或者缓存非空*/
if((g_diagSocpIsEnable != TRUE) || (ERR_MSP_SUCCESS != diag_PortDataBufIsEmpty()))
{
DIAG_DEBUG_SDM_FUN(EN_DIAG_DEBUG_UDI_READ_END,0,0,3);
diag_PortAddToDataBuf(enPort, (VOS_UINT8 *)(pdata),ulDataLen);
ret = (VOS_UINT32)udi_ioctl(ulUdiHandle,UDI_ACM_IOCTL_RETUR_BUFFER_CB,&acmInfo);
if(ret)
{
DIAG_DEBUG_SDM_FUN(EN_DIAG_DEBUG_UDI_READ_END,0,0,4);
diag_printf("[%s]:return buffer to acm err 0x%x!!!!!!!!\n",__func__,ret);
}
if(ERR_MSP_SUCCESS != diag_SendMsg(MSP_PID_DIAG_APP_AGENT, MSP_PID_DIAG_APP_AGENT,
ID_MSG_DIAG_CMD_PORT_REQ_TO_APP_AGENT, (VOS_UINT8 *)&ret, sizeof(VOS_UINT32)))
{
DIAG_DEBUG_SDM_FUN(EN_DIAG_DEBUG_UDI_READ_END,0,0,5);
diag_printf("[%s]:send msg to diag app agent fail!!!!!!!!\n",__func__);
}
return;
}
#endif
ret = SCM_SendDecoderSrc(DIAG_PORT_GET_DECODE_SRC(enPort),(VOS_UINT8 *)(pdata),ulDataLen);
if(ret)
{
DIAG_DEBUG_SDM_FUN(EN_DIAG_DEBUG_UDI_READ_END,0,0,6);
diag_printf("[%s]:SCM_SendDecoderSrc err 0x%x!!!!!!!!\n",__func__,ret);
}
ret = (VOS_UINT32)udi_ioctl(ulUdiHandle,UDI_ACM_IOCTL_RETUR_BUFFER_CB,&acmInfo);
if(ret)
{
DIAG_DEBUG_SDM_FUN(EN_DIAG_DEBUG_UDI_READ_END,0,0,7);
diag_printf("[%s]:SCM_SendDecoderSrc err 0x%x!!!!!!!!\n",__func__,ret);
}
return;
}
