/***************************************************************************** 函 数 名 : diag_PortClose 功能描述 : 输入参数 : 输出参数 : 返 回 值 : 调用函数 : 被调函数 : 修改历史 : 1.日 期 : 2012年8月27日 修改内容 : Creat Function *****************************************************************************/ VOS_UINT32 diag_PortClose(DIAG_PORT_PHY_BEAR_ENUM enPort) { VOS_INT32 slVcomRet = 0; VOS_INT32 slHandle = UDI_INVALID_HANDLE; slHandle = DIAG_PORT_GET_HANDLE(enPort); if(slHandle ==UDI_INVALID_HANDLE) { return ERR_MSP_SUCCESS; } DIAG_DEBUG_SDM_FUN((DIAG_DEBUG_MSG_ID_ENUM)(EN_DIAG_DEBUG_TCP_CLOSE+(VOS_UINT32)enPort), 0, 0, 0); g_diagPort_ctrl.bFlag = VOS_FALSE; slVcomRet = udi_close(slHandle); if (slVcomRet == ERR_MSP_SUCCESS) { DIAG_PORT_HANDLE_SWITCH(enPort,UDI_INVALID_HANDLE); DIAG_PORT_CHAN_STATE_SWITCH(enPort,ACM_EVT_DEV_SUSPEND); return (VOS_UINT32)slVcomRet; } DIAG_DEBUG_SDM_FUN((DIAG_DEBUG_MSG_ID_ENUM)(EN_DIAG_DEBUG_TCP_CLOSE_ERR+(VOS_UINT32)enPort), (VOS_UINT32)slVcomRet, 0, 0); return ERR_MSP_FAILURE; }
VOS_UINT32 diag_PhyWriteAsync(DIAG_PORT_PHY_BEAR_ENUM enPort,VOS_UINT8 *pucDataBuf,VOS_UINT32 ulLen) { VOS_INT32 ret = ERR_MSP_SUCCESS; ACM_WR_ASYNC_INFO stVcom = {0}; VOS_INT32 slHandle = 0; if(DIAG_PORT_GET_STATE(enPort) ==ACM_EVT_DEV_SUSPEND) { SCM_RlsDestBuf(DIAG_PORT_GET_CODE_DES(enPort),ulLen); return ERR_MSP_SUCCESS; } slHandle = DIAG_PORT_GET_HANDLE(enPort); if(slHandle == UDI_INVALID_HANDLE) { SCM_RlsDestBuf(DIAG_PORT_GET_CODE_DES(enPort),ulLen); return ERR_MSP_FAILURE; } #if(FEATURE_SOCP_ON_DEMAND == FEATURE_ON) /* 工具已下发断开连接命令,丢数据 */ if(!(g_ulDiagCfgInfo & (1 << 1))) { SCM_RlsDestBuf(DIAG_PORT_GET_CODE_DES(enPort),ulLen); return ERR_MSP_SUCCESS; } #endif #ifdef FEATURE_UPGRADE_TL stVcom.pBuffer = (VOS_CHAR*)pucDataBuf; #else stVcom.pVirAddr = (VOS_CHAR*)pucDataBuf; stVcom.pPhyAddr = (VOS_CHAR*)SCM_CoderDestMemVirtToPhy(DIAG_PORT_GET_CODE_DES(enPort), pucDataBuf); #endif stVcom.u32Size = ulLen; DIAG_DEBUG_SDM_FUN((DIAG_DEBUG_MSG_ID_ENUM)(EN_DIAG_DEBUG_TCP_WRT+(VOS_UINT32)enPort), ulLen, 0, 0); ret = udi_ioctl((int)slHandle, ACM_IOCTL_WRITE_ASYNC, &stVcom); if(ret == ERR_MSP_SUCCESS) { DIAG_DEBUG_SDM_FUN((DIAG_DEBUG_MSG_ID_ENUM)(EN_DIAG_DEBUG_TCP_WRT_SUCC+(VOS_UINT32)enPort), ulLen, 0, 0); return ERR_MSP_SUCCESS; } SCM_RlsDestBuf(DIAG_PORT_GET_CODE_DES(enPort),ulLen); return (VOS_UINT32)ret;/* [false alarm]:屏蔽Fortify */ }
VOS_UINT32 diag_PhyWriteAsync(DIAG_PORT_PHY_BEAR_ENUM enPort,VOS_UINT8 *pucDataBuf,VOS_UINT32 ulLen) { VOS_INT32 ret = ERR_MSP_SUCCESS; ACM_WR_ASYNC_INFO stVcom = {0}; VOS_INT32 slHandle = 0; if(DIAG_PORT_GET_STATE(enPort) ==ACM_EVT_DEV_SUSPEND) { SCM_RlsDestBuf(DIAG_PORT_GET_CODE_DES(enPort),ulLen); return ERR_MSP_SUCCESS; } slHandle = DIAG_PORT_GET_HANDLE(enPort); if(slHandle == UDI_INVALID_HANDLE) { SCM_RlsDestBuf(DIAG_PORT_GET_CODE_DES(enPort),ulLen); return ERR_MSP_FAILURE; } stVcom.pBuffer = (VOS_CHAR*)pucDataBuf; stVcom.u32Size = ulLen; DIAG_DEBUG_SDM_FUN(EN_DIAG_DEBUG_TCP_WRT+enPort, ulLen, 0, 0); ret = udi_ioctl((int)slHandle, ACM_IOCTL_WRITE_ASYNC, &stVcom); if(ret == ERR_MSP_SUCCESS) { DIAG_DEBUG_SDM_FUN(EN_DIAG_DEBUG_TCP_WRT_SUCC+enPort, ulLen, 0, 0); return ERR_MSP_SUCCESS; } SCM_RlsDestBuf(DIAG_PORT_GET_CODE_DES(enPort),ulLen); return ret; }
/***************************************************************************** 函 数 名 : diag_PortOpen 功能描述 : 输入参数 : 输出参数 : 返 回 值 : 调用函数 : 被调函数 : 修改历史 : 1.日 期 : 2012年8月27日 修改内容 : Creat Function *****************************************************************************/ VOS_UINT32 diag_PortOpen(DIAG_PORT_PHY_BEAR_ENUM enPort,UDI_DEVICE_ID devid,\ VOS_VOID * pEvtCB,VOS_VOID* pWrtCB,VOS_VOID* pRdCB) { UDI_HANDLE slUartHd = 0; VOS_UINT32 ret = ERR_MSP_SUCCESS; UDI_OPEN_PARAM stParam = {0}; ACM_READ_BUFF_INFO stReadParam; if(DIAG_PORT_GET_HANDLE(enPort) != UDI_INVALID_HANDLE) { return ERR_MSP_SUCCESS; } DIAG_DEBUG_SDM_FUN(EN_DIAG_DEBUG_TCP_OPEN+enPort, 0, 0, 0); stParam.devid = devid; slUartHd = udi_open(&stParam); if(UDI_INVALID_HANDLE == slUartHd) { return ERR_MSP_FAILURE; } stReadParam.u32BuffSize = DIAG_DATA_READ_BUFFER_SIZE; stReadParam.u32BuffNum = DIAG_DATA_MAX_BUFFER_COUNT; ret = udi_ioctl(slUartHd,ACM_IOCTL_RELLOC_READ_BUFF,&stReadParam); if(ret) { DIAG_DEBUG_SDM_FUN(EN_DIAG_DEBUG_TCP_OPEN_ERR+enPort, (VOS_UINT32)slUartHd, ret, 1); goto ERR_OUT; } ret = udi_ioctl(slUartHd,ACM_IOCTL_SEND_BUFF_CAN_DMA,&stReadParam); if(ret) { DIAG_DEBUG_SDM_FUN(EN_DIAG_DEBUG_TCP_OPEN_ERR+enPort, (VOS_UINT32)slUartHd, ret, 2); goto ERR_OUT; } ret = udi_ioctl((int)slUartHd,ACM_IOCTL_SET_READ_CB, pRdCB); if(ret) { DIAG_DEBUG_SDM_FUN(EN_DIAG_DEBUG_TCP_OPEN_ERR+enPort, (VOS_UINT32)slUartHd, ret, 3); goto ERR_OUT; } ret = udi_ioctl((int)slUartHd,ACM_IOCTL_SET_WRITE_CB, pWrtCB); if(ret) { DIAG_DEBUG_SDM_FUN(EN_DIAG_DEBUG_TCP_OPEN_ERR+enPort, (VOS_UINT32)slUartHd, ret, 4); goto ERR_OUT; } ret = udi_ioctl((int)slUartHd, (int)ACM_IOCTL_SET_EVT_CB, pEvtCB); if(ret) { DIAG_DEBUG_SDM_FUN(EN_DIAG_DEBUG_TCP_OPEN_ERR+enPort, (VOS_UINT32)slUartHd, ret, 5); goto ERR_OUT; } ret = udi_ioctl((int)slUartHd, (int)ACM_IOCTL_WRITE_DO_COPY, 0); if(ret) { DIAG_DEBUG_SDM_FUN(EN_DIAG_DEBUG_TCP_OPEN_ERR+enPort, (VOS_UINT32)slUartHd, ret, 6); goto ERR_OUT; } g_diagPort_ctrl.bFlag = VOS_TRUE; DIAG_PORT_HANDLE_SWITCH(enPort,slUartHd); /*修改端口句柄*/ DIAG_PORT_CHAN_STATE_SWITCH(enPort,ACM_EVT_DEV_READY);/*打开之后修改端口状态*/ return ERR_MSP_SUCCESS; ERR_OUT: udi_close(slUartHd); return ret; }
/***************************************************************************** 函 数 名 : 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; }