HRESULT MV_CC_DSS_Exit(void)
{
HRESULT res;
if (pMV_APP_DSS == NULL)
MV_CC_DBG_Error(E_NOTREADY, "MV_CC_DSS_Exit", NULL);
MV_OSAL_Mutex_Lock(pMV_APP_DSS->m_hGSListMutex);
res = MV_CC_DSS_GlobalServiceList_Exit();
if (res != S_OK)
MV_CC_DBG_Error(res, "MV_CC_DSS_Exit" \
" MV_CC_DSS_GlobalServiceList_Exit", NULL);
MV_OSAL_Mutex_Unlock(pMV_APP_DSS->m_hGSListMutex);
MV_OSAL_Mutex_Destroy(&(pMV_APP_DSS->m_hGSListMutex));
MV_OSAL_Mutex_Destroy(&(pMV_APP_DSS->m_SeqIDMutex));
MV_OSAL_Free(pMV_APP_DSS);
pMV_APP_DSS = NULL;
return S_OK;
}
HRESULT MV_CC_DSS_Reg(pMV_CC_DSS_ServiceInfo_t pSrvInfo)
{
HRESULT res;
pMV_CC_ICCNet_t pICCNet;
pMV_CC_DSS_ServiceInfo_t pSrvInfo_copy;
if (pSrvInfo == NULL)
MV_CC_DBG_Error(E_INVALIDARG, "MV_CC_DSS_Reg", NULL);
if (pMV_APP_DSS == NULL)
MV_CC_DBG_Error(E_NOTREADY, "MV_CC_DSS_Reg", NULL);
pICCNet = pMV_APP_DSS->m_pICCNet;
// check service id need dynamic generator?
if (pSrvInfo->m_ServiceID == MV_CC_ServiceID_DynamicApply)
{
//get a new dynamic service id
pSrvInfo->m_ServiceID = MV_CC_DSS_GetDynamicSID(pMV_APP_DSS);
if (pSrvInfo->m_ServiceID == MV_CC_ServiceID_None)
MV_CC_DBG_Error(E_FAIL, "MV_CC_DSS_Reg", NULL);
}
pSrvInfo_copy = MV_CC_DSS_GlobalServiceList_SrvInfo_Ctor();
if (pSrvInfo_copy == NULL)
MV_CC_DBG_Error(E_OUTOFMEMORY, "MV_CC_DSS_Reg", NULL);
GaloisMemcpy(pSrvInfo_copy, pSrvInfo, sizeof(MV_CC_DSS_ServiceInfo_t));
MV_OSAL_Mutex_Lock(pMV_APP_DSS->m_hGSListMutex);
res = MV_CC_DSS_GlobalServiceList_Add(pSrvInfo->m_ServiceID, pSrvInfo_copy);
if (res != S_OK)
{
MV_CC_DBG_Warning(res, "MV_CC_DSS_Reg MV_CC_DSS_GlobalServiceList_Add", NULL);
goto MV_CC_DSS_Reg_Failure;
}
// Only for test
//res = MV_CC_DSS_GlobalServiceList_Traversal(GSList_VisitFunc_Demo, NULL);
MV_OSAL_Mutex_Unlock(pMV_APP_DSS->m_hGSListMutex);
// Synchronize with Remote CPU
res = MV_CC_DSS_DSPSendTo( pMV_APP_DSS,
pMV_APP_DSS->m_RemoteCPU,
DSPPacket_HeadGEN(CMD_DSS_Add, 1, 0, 0),
(UCHAR *)pSrvInfo,
sizeof(MV_CC_DSS_ServiceInfo_t));
if (res == E_FULL)
res = S_OK;
return res;
MV_CC_DSS_Reg_Failure:
MV_OSAL_Mutex_Unlock(pMV_APP_DSS->m_hGSListMutex);
return res;
}
HRESULT MV_CC_DSS_GetList(pMV_CC_DSS_ServiceInfo_DataList_t pSrvInfoList)
{
HRESULT res;
pMV_CC_ICCNet_t pICCNet;
if ((pSrvInfoList == NULL) || (pSrvInfoList->m_ListNum == 0))
MV_CC_DBG_Error(E_INVALIDARG, "MV_CC_DSS_GetList", NULL);
if (pMV_APP_DSS == NULL)
MV_CC_DBG_Error(E_NOTREADY, "MV_CC_DSS_GetList", NULL);
pICCNet = pMV_APP_DSS->m_pICCNet;
pSrvInfoList->m_DataNum = 0;
pSrvInfoList->m_MaxNum = 0;
MV_OSAL_Mutex_Lock(pMV_APP_DSS->m_hGSListMutex);
res = MV_CC_DSS_GlobalServiceList_Traversal(GSList_VisitFunc_GetList, pSrvInfoList);
if (res != S_OK)
MV_CC_DBG_Warning(res, "MV_CC_DSS_GetList MV_CC_DSS_GlobalServiceList_Traversal", NULL);
MV_OSAL_Mutex_Unlock(pMV_APP_DSS->m_hGSListMutex);
return res;
}
HRESULT MV_CC_DSS_Free(pMV_CC_DSS_ServiceInfo_t pSrvInfo,
MV_CC_Task *cc_task)
{
HRESULT res;
if (pSrvInfo == NULL)
MV_CC_DBG_Error(E_INVALIDARG, "MV_CC_DSS_Free", NULL);
if (pMV_APP_DSS == NULL)
MV_CC_DBG_Error(E_NOTREADY, "MV_CC_DSS_Free", NULL);
MV_OSAL_Mutex_Lock(pMV_APP_DSS->m_hGSListMutex);
singlenode_delete(cc_task->serverid_head, pSrvInfo->m_ServiceID);
res = MV_CC_DSS_GlobalServiceList_Delete(pSrvInfo->m_ServiceID);
if (res != S_OK) {
pMV_APP_DSS->m_Status.m_FreeErrCount++;
MV_CC_DBG_Warning(res, "MV_CC_DSS_Free"
" MV_CC_DSS_GlobalServiceList_Delete", NULL);
goto MV_CC_DSS_Free_Failure;
}
pMV_APP_DSS->m_Status.m_FreeCount++;
pMV_APP_DSS->m_Status.m_ServiceCount--;
pMV_APP_DSS->m_Status.m_LastServiceID = pSrvInfo->m_ServiceID;
MV_CC_DSS_Free_Failure:
MV_OSAL_Mutex_Unlock(pMV_APP_DSS->m_hGSListMutex);
return res;
}
HRESULT MV_CC_DSS_Inquiry(pMV_CC_DSS_ServiceInfo_t pSrvInfo)
{
HRESULT res;
pMV_CC_DSS_ServiceInfo_t pSrvInfo_Search;
if (pSrvInfo == NULL)
MV_CC_DBG_Error(E_INVALIDARG, "MV_CC_DSS_Inquiry", NULL);
if (pMV_APP_DSS == NULL)
MV_CC_DBG_Error(E_NOTREADY, "MV_CC_DSS_Inquiry", NULL);
MV_OSAL_Mutex_Lock(pMV_APP_DSS->m_hGSListMutex);
res = MV_CC_DSS_GlobalServiceList_Get(pSrvInfo->m_ServiceID, &pSrvInfo_Search);
if (res != S_OK)
{
//MV_CC_DBG_Warning(res, "MV_CC_DSS_Inquiry MV_CC_DSS_GlobalServiceList_Get", NULL);
goto MV_CC_DSS_Inquiry_Failure;
}
// Only for test
//res = MV_CC_DSS_GlobalServiceList_Traversal(GSList_VisitFunc_Demo, NULL);
if (pSrvInfo_Search != NULL)
GaloisMemcpy(pSrvInfo, pSrvInfo_Search, sizeof(MV_CC_DSS_ServiceInfo_t));
MV_CC_DSS_Inquiry_Failure:
MV_OSAL_Mutex_Unlock(pMV_APP_DSS->m_hGSListMutex);
return res;
}
HRESULT MV_CC_MsgQEx_PostMsgByID(MV_CC_ServiceID_U32_t ServiceID,
PVOID pMSG)
{
HRESULT res;
MV_CC_DSS_ServiceInfo_MsgQEx_t SrvInfo;
pMV_CC_MSGEx_t pMSGEx = pMSG;
/* Parameter Check */
if (pMSG == NULL)
MV_CC_DBG_Error(E_INVALIDARG, "MV_CC_MsgQEx_PostMsgByID", NULL);
SrvInfo.m_ServiceID = ServiceID;
res = MV_CC_DSS_Inquiry((pMV_CC_DSS_ServiceInfo_t)&SrvInfo);
if (res != S_OK)
MV_CC_DBG_Error(res, "MV_CC_MsgQEx_PostMsgByID MV_CC_DSS_Inquiry", NULL);
if (pMSGEx->m_MsgLen > MV_CC_MSGQ_DATA_MSGEXLEN_MAX)
{
res = E_BADVALUE;
MV_CC_DBG_Error(res, "MV_CC_MsgQEx_PostMsgByID MsgLen", NULL);
}
res = MV_CC_UDP_SendMsg(NULL, ServiceID, pMSG, pMSGEx->m_MsgLen + 1);
if (res != S_OK)
MV_CC_DBG_Error(res, "MV_CC_MsgQEx_PostMsgByID MV_CC_UDP_SendMsg", NULL);
return res;
}
HRESULT MV_CC_DSS_Reg(pMV_CC_DSS_ServiceInfo_t pSrvInfo,
MV_CC_Task *cc_task )
{
HRESULT res;
pMV_CC_DSS_ServiceInfo_t pSrvInfo_copy;
if (pSrvInfo == NULL)
MV_CC_DBG_Error(E_INVALIDARG, "MV_CC_DSS_Reg", NULL);
if (pMV_APP_DSS == NULL)
MV_CC_DBG_Error(E_NOTREADY, "MV_CC_DSS_Reg", NULL);
MV_OSAL_Mutex_Lock(pMV_APP_DSS->m_hGSListMutex);
// check service id need dynamic generator?
if (pSrvInfo->m_ServiceID == MV_CC_ServiceID_DynamicApply) {
//get a new dynamic service id
pSrvInfo->m_ServiceID = MV_CC_DSS_GetDynamicSID(pMV_APP_DSS);
if (pSrvInfo->m_ServiceID == MV_CC_ServiceID_None) {
pMV_APP_DSS->m_Status.m_RegErrCount++;
MV_OSAL_Mutex_Unlock(pMV_APP_DSS->m_hGSListMutex);
MV_CC_DBG_Error(E_FAIL, "MV_CC_DSS_Reg", NULL);
}
}
pSrvInfo_copy = MV_CC_DSS_GlobalServiceList_SrvInfo_Ctor();
if (pSrvInfo_copy == NULL) {
MV_OSAL_Mutex_Unlock(pMV_APP_DSS->m_hGSListMutex);
MV_CC_DBG_Error(E_OUTOFMEMORY, "MV_CC_DSS_Reg", NULL);
}
GaloisMemcpy(pSrvInfo_copy, pSrvInfo, sizeof(MV_CC_DSS_ServiceInfo_t));
res = MV_CC_DSS_GlobalServiceList_Add(pSrvInfo->m_ServiceID,
pSrvInfo_copy);
if (res != S_OK) {
pMV_APP_DSS->m_Status.m_RegErrCount++;
MV_CC_DBG_Warning(res, "MV_CC_DSS_Reg"
" MV_CC_DSS_GlobalServiceList_Add", NULL);
goto MV_CC_DSS_Reg_Failure;
}
singlenode_add(cc_task->serverid_head, pSrvInfo->m_ServiceID);
pMV_APP_DSS->m_Status.m_RegCount++;
pMV_APP_DSS->m_Status.m_ServiceCount++;
pMV_APP_DSS->m_Status.m_LastServiceID = pSrvInfo->m_ServiceID;
MV_CC_DSS_Reg_Failure:
MV_OSAL_Mutex_Unlock(pMV_APP_DSS->m_hGSListMutex);
return res;
}
HRESULT MV_CC_DSS_GetStatus(pMV_CC_DSS_Status_t pStatus)
{
if (pStatus == NULL)
MV_CC_DBG_Error(E_INVALIDARG, "MV_CC_DSS_GetStatus", NULL);
if (pMV_APP_DSS == NULL)
MV_CC_DBG_Error(E_NOTREADY, "MV_CC_DSS_GetStatus", NULL);
GaloisMemcpy(pStatus, &(pMV_APP_DSS->m_Status),
sizeof(MV_CC_DSS_Status_t));
return S_OK;
}
HRESULT MV_CC_DSS_Free(pMV_CC_DSS_ServiceInfo_t pSrvInfo)
{
HRESULT res;
pMV_CC_ICCNet_t pICCNet;
if (pSrvInfo == NULL)
MV_CC_DBG_Error(E_INVALIDARG, "MV_CC_DSS_Free", NULL);
if (pMV_APP_DSS == NULL)
MV_CC_DBG_Error(E_NOTREADY, "MV_CC_DSS_Free", NULL);
pICCNet = pMV_APP_DSS->m_pICCNet;
MV_OSAL_Mutex_Lock(pMV_APP_DSS->m_hGSListMutex);
res = MV_CC_DSS_GlobalServiceList_Delete(pSrvInfo->m_ServiceID);
if (res != S_OK)
{
MV_CC_DBG_Warning(res, "MV_CC_DSS_Free MV_CC_DSS_GlobalServiceList_Delete", NULL);
goto MV_CC_DSS_Free_Failure;
}
// Only for test
//res = MV_CC_DSS_GlobalServiceList_Traversal(GSList_VisitFunc_Demo, NULL);
MV_OSAL_Mutex_Unlock(pMV_APP_DSS->m_hGSListMutex);
// Synchronize with Remote CPU
res = MV_CC_DSS_DSPSendTo( pMV_APP_DSS,
pMV_APP_DSS->m_RemoteCPU,
DSPPacket_HeadGEN(CMD_DSS_Delete, 1, 0, 0),
(UCHAR *)pSrvInfo,
sizeof(MV_CC_DSS_ServiceInfo_t));
if (res == E_FULL)
res = S_OK;
return res;
MV_CC_DSS_Free_Failure:
MV_OSAL_Mutex_Unlock(pMV_APP_DSS->m_hGSListMutex);
return res;
}
HRESULT MV_CC_DSS_Update(pMV_CC_DSS_ServiceInfo_t pSrvInfo)
{
HRESULT res;
pMV_CC_DSS_ServiceInfo_t pSrvInfo_Search;
if (pSrvInfo == NULL)
MV_CC_DBG_Error(E_INVALIDARG, "MV_CC_DSS_Update", NULL);
if (pMV_APP_DSS == NULL)
MV_CC_DBG_Error(E_NOTREADY, "MV_CC_DSS_Update", NULL);
// check service id
if (pSrvInfo->m_ServiceID == MV_CC_ServiceID_DynamicApply)
MV_CC_DBG_Error(E_BADVALUE, "MV_CC_DSS_Update", NULL);
MV_OSAL_Mutex_Lock(pMV_APP_DSS->m_hGSListMutex);
res = MV_CC_DSS_GlobalServiceList_Get(pSrvInfo->m_ServiceID, \
&pSrvInfo_Search);
if (res != S_OK) {
pMV_APP_DSS->m_Status.m_UpdateErrCount++;
goto MV_CC_DSS_Update_Failure;
}
if (pSrvInfo_Search != NULL) {
GaloisMemcpy(pSrvInfo_Search, pSrvInfo, \
sizeof(MV_CC_DSS_ServiceInfo_t));
} else {
pMV_APP_DSS->m_Status.m_UpdateErrCount++;
goto MV_CC_DSS_Update_Failure;
}
pMV_APP_DSS->m_Status.m_UpdateCount++;
pMV_APP_DSS->m_Status.m_LastServiceID = pSrvInfo->m_ServiceID;
MV_CC_DSS_Update_Failure:
MV_OSAL_Mutex_Unlock(pMV_APP_DSS->m_hGSListMutex);
return res;
}
HRESULT MV_CC_CBufBody_Destroy(UINT32 SHMOffset)
{
HRESULT res;
MV_CC_DBG_Info("MV_CC_CBufBody_Destroy"
" SHM Offset = [0x%08X]", SHMOffset);
/* Parameter Check */
if (SHMOffset == ERROR_SHM_MALLOC_FAILED) {
MV_CC_DBG_Error(E_INVALIDARG,
"MV_CC_CBufBody_Destroy", NULL);
}
res = MV_SHM_Free( SHMOffset );
if (res != S_OK) {
MV_CC_DBG_Error(res, "MV_CC_CBufBody_Destroy"
" MV_SHM_Free", NULL);
}
return res;
}
HRESULT MV_CC_DSS_Init(void)
{
HRESULT res;
if (pMV_APP_DSS != NULL)
MV_CC_DBG_Error(E_NOTREADY, "MV_CC_DSS_Init", NULL);
pMV_APP_DSS = MV_OSAL_Malloc(sizeof(MV_CC_DSP_t));
if (pMV_APP_DSS == NULL)
MV_CC_DBG_Error(E_OUTOFMEMORY, "MV_CC_DSS_Init"
" MV_OSAL_Malloc", NULL);
pMV_APP_DSS->m_SeqID = MV_CC_ServiceID_DynamicStart;
MV_OSAL_Mutex_Create(&(pMV_APP_DSS->m_SeqIDMutex));
MV_OSAL_Mutex_Create(&(pMV_APP_DSS->m_hGSListMutex));
MV_OSAL_Mutex_Lock(pMV_APP_DSS->m_hGSListMutex);
res = MV_CC_DSS_GlobalServiceList_Init();
if (res != S_OK)
MV_CC_DBG_Error(res, "MV_CC_DSS_Init"
" MV_CC_DSS_GlobalServiceList_Init", NULL);
pMV_APP_DSS->m_Status.m_RegCount =
pMV_APP_DSS->m_Status.m_RegErrCount =
pMV_APP_DSS->m_Status.m_FreeCount =
pMV_APP_DSS->m_Status.m_FreeErrCount =
pMV_APP_DSS->m_Status.m_InquiryCount =
pMV_APP_DSS->m_Status.m_InquiryErrCount =
pMV_APP_DSS->m_Status.m_UpdateCount =
pMV_APP_DSS->m_Status.m_UpdateErrCount =
pMV_APP_DSS->m_Status.m_ServiceCount =
pMV_APP_DSS->m_Status.m_LastServiceID = 0;
pMV_APP_DSS->m_Status.m_SeqID = pMV_APP_DSS->m_SeqID;
MV_OSAL_Mutex_Unlock(pMV_APP_DSS->m_hGSListMutex);
return S_OK;
}
HRESULT MV_CC_DSS_Destructor(pMV_CC_DSP_t self)
{
HRESULT res;
/* Parameter Check */
if (self == NULL)
MV_CC_DBG_Error(E_INVALIDARG, "MV_CC_DSS_Destructor", NULL);
if (pMV_APP_DSS == NULL)
MV_CC_DBG_Error(E_NOTREADY, "MV_CC_DSS_Destructor", NULL);
pMV_APP_DSS = NULL;
MV_OSAL_Mutex_Lock(self->m_hGSListMutex);
res = MV_CC_DSS_GlobalServiceList_Exit();
if (res != S_OK)
MV_CC_DBG_Error(res, "MV_CC_DSS_Destructor MV_CC_DSS_GlobalServiceList_Exit", NULL);
MV_OSAL_Mutex_Unlock(self->m_hGSListMutex);
MV_OSAL_Mutex_Destroy(&(self->m_hGSListMutex));
MV_OSAL_Mutex_Destroy(&(self->m_SeqIDMutex));
self->m_PrType = MV_CC_Protocol_TEST;
self->OnRecvDemux = NULL;
self->m_pICCNet = NULL;
self->m_RdCount = 0;
self->m_RdErrCount = 0;
self->m_WrCount = 0;
self->m_WrErrCount = 0;
self->m_bStatusUpdate = false;
self->m_RemoteCPU = MV_CC_DSS_REMOTECPU_NONE;
self->m_SeqID = MV_CC_ServiceID_DynamicStart;
return S_OK;
}
HRESULT MV_CC_DSS_Inquiry(pMV_CC_DSS_ServiceInfo_t pSrvInfo)
{
HRESULT res;
pMV_CC_DSS_ServiceInfo_t pSrvInfo_Search;
if (pSrvInfo == NULL)
MV_CC_DBG_Error(E_INVALIDARG, "MV_CC_DSS_Inquiry", NULL);
if (pMV_APP_DSS == NULL)
MV_CC_DBG_Error(E_NOTREADY, "MV_CC_DSS_Inquiry", NULL);
MV_OSAL_Mutex_Lock(pMV_APP_DSS->m_hGSListMutex);
res = MV_CC_DSS_GlobalServiceList_Get(pSrvInfo->m_ServiceID, \
&pSrvInfo_Search);
if (res != S_OK) {
pMV_APP_DSS->m_Status.m_InquiryErrCount++;
goto MV_CC_DSS_Inquiry_Failure;
}
if (pSrvInfo_Search != NULL)
GaloisMemcpy(pSrvInfo, pSrvInfo_Search, \
sizeof(MV_CC_DSS_ServiceInfo_t));
else {
pMV_APP_DSS->m_Status.m_InquiryErrCount++;
goto MV_CC_DSS_Inquiry_Failure;
}
pMV_APP_DSS->m_Status.m_InquiryCount++;
pMV_APP_DSS->m_Status.m_LastServiceID = pSrvInfo->m_ServiceID;
MV_CC_DSS_Inquiry_Failure:
MV_OSAL_Mutex_Unlock(pMV_APP_DSS->m_hGSListMutex);
return res;
}
HRESULT DSS_Update(pMV_CC_DSP_t self)
{
HRESULT res;
pMV_CC_DSP_t pHandle;
/* Parameter Check */
if ((pHandle = (pMV_CC_DSP_t)self ) == NULL)
MV_CC_DBG_Error(E_INVALIDARG, "DSS_Update", NULL);
MV_OSAL_Mutex_Lock(pHandle->m_hGSListMutex);
// Traversal Golbal Service List and Update
res = MV_CC_DSS_GlobalServiceList_Traversal(GSList_VisitFunc_Update, (PVOID)pHandle);
if (res != S_OK)
{
MV_CC_DBG_Warning(res, "DSS_Update MV_CC_DSS_GlobalServiceList_Traversal", NULL);
MV_OSAL_Mutex_Unlock(pHandle->m_hGSListMutex);
// Send CMD_DSS_UpdateOK;
res = MV_CC_DSS_DSPSendTo( pHandle,
pHandle->m_RemoteCPU,
DSPPacket_HeadGEN(CMD_DSS_UpdateError, 0, 0, 0),
NULL,
0);
}
else
{
MV_OSAL_Mutex_Unlock(pHandle->m_hGSListMutex);
// Send CMD_DSS_UpdateOK;
res = MV_CC_DSS_DSPSendTo( pHandle,
pHandle->m_RemoteCPU,
DSPPacket_HeadGEN(CMD_DSS_UpdateOK, 0, 0, 0),
NULL,
0);
}
if (res == E_FULL)
res = S_OK;
return res;
}
HRESULT MV_CC_CBufBody_Create(UINT32 *pSHMOffset,
UINT32 BufSize,
UINT32 EndBlockSize,
UINT32 Flags)
{
pMV_CC_CBufBody_t pCBufBody;
UINT32 CBuf_FullSize, SHMOffset;
HRESULT res;
#ifdef ENABLE_DEBUG_OSAL
//Fill the end padding
UINT32 buflen = BufSize;
#endif
/* Parameter Check */
if (pSHMOffset == NULL)
MV_CC_DBG_Error(E_INVALIDARG, "MV_CC_CBufBody_Create", NULL);
CBuf_FullSize = sizeof(MV_CC_CBufBody_t) + BufSize;
/* Check Flag->MV_CC_CBUF_FLAGS_ALIGNMENT */
if ((MV_CC_FlagGet(Flags, MV_CC_CBUF_FLAGS_ALIGNMENT)) \
== MV_CC_CBUF_FLAGS_ALIGNMENT_Yes)
CBuf_FullSize += MV_CC_HAL_MEMBOUNDARY;
/* If EndBlockSize == 0, no End Block for the MV_CC_CBufBody_t
and no limitation to the Block Operation */
if (EndBlockSize != 0)
CBuf_FullSize += EndBlockSize;
//Cbuf use cacheable memory in kernel driver, then use related virt addr
SHMOffset = MV_SHM_Malloc(CBuf_FullSize, MV_CC_HAL_MEMBOUNDARY);
if (SHMOffset == ERROR_SHM_MALLOC_FAILED) {
*pSHMOffset = ERROR_SHM_MALLOC_FAILED;
res = E_OUTOFMEMORY;
MV_CC_DBG_Error(res, "MV_CC_CBufBody_Create MV_SHM_Malloc", NULL);
return res;
}
MV_SHM_Takeover(SHMOffset);
pCBufBody = (pMV_CC_CBufBody_t)MV_SHM_GetCacheVirtAddr(SHMOffset);
if (pCBufBody == NULL) {
MV_CC_DBG_Error(E_INVALIDARG, "MV_CC_CBufBody_Create", NULL);
}
GaloisMemClear((void *)pCBufBody, CBuf_FullSize);
pCBufBody->m_StartOffset = sizeof(MV_CC_CBufBody_t);
if ((MV_CC_FlagGet(Flags, MV_CC_CBUF_FLAGS_ALIGNMENT))
== MV_CC_CBUF_FLAGS_ALIGNMENT_Yes) {
pCBufBody->m_StartOffset += MV_CC_HAL_MEMBOUNDARY -
(((UINT32)pCBufBody + pCBufBody->m_StartOffset)
% MV_CC_HAL_MEMBOUNDARY );
}
//Fill the padding with 0xFF for debug easily
#ifdef ENABLE_DEBUG_OSAL
//Fill the front padding
GaloisMemSet((void *)((UCHAR *)pCBufBody +
sizeof(MV_CC_CBufBody_t)), 0xFF,
(pCBufBody->m_StartOffset -
sizeof(MV_CC_CBufBody_t)) );
if ( EndBlockSize != 0 )
buflen += EndBlockSize;
GaloisMemSet((void *)((UCHAR *)pCBufBody +
pCBufBody->m_StartOffset + buflen),
0xFF, CBuf_FullSize - pCBufBody->m_StartOffset
- buflen);
#endif
pCBufBody->m_BufSize = BufSize;
pCBufBody->m_EndBlockSize = EndBlockSize;
pCBufBody->m_Flags = Flags;
*pSHMOffset = SHMOffset;
MV_CC_DBG_Info("DSS MV_CC_CBufBody_Create"
" SHM Offset = [0x%08X]",SHMOffset);
return S_OK;
}
HRESULT MV_CC_DSS_Constructor( pMV_CC_DSP_t self,
pMV_CC_ICCNet_t pICCNet)
{
HRESULT res;
/* Parameter Check */
if ((self == NULL) || (pICCNet == NULL))
MV_CC_DBG_Error(E_INVALIDARG, "MV_CC_DSS_Constructor", NULL);
if (pMV_APP_DSS != NULL)
MV_CC_DBG_Error(E_NOTREADY, "MV_CC_DSS_Constructor", NULL);
self->m_PrType = MV_CC_Protocol_CCDSP;
self->OnRecvDemux = MV_CC_DSS_DSPOnRecvDemux;
self->m_pICCNet = pICCNet;
self->m_RdCount = 0;
self->m_RdErrCount = 0;
self->m_WrCount = 0;
self->m_WrErrCount = 0;
self->m_bStatusUpdate = false;
self->m_RemoteCPU = MV_CC_DSS_REMOTECPU_INIT;
self->m_SeqID = MV_CC_ServiceID_DynamicStart;
MV_OSAL_Mutex_Create(&(self->m_SeqIDMutex));
MV_OSAL_Mutex_Create(&(self->m_hGSListMutex));
MV_OSAL_Mutex_Lock(self->m_hGSListMutex);
res = MV_CC_DSS_GlobalServiceList_Init();
if (res != S_OK)
MV_CC_DBG_Error(res, "MV_CC_DSS_Constructor MV_CC_DSS_GlobalServiceList_Init", NULL);
MV_OSAL_Mutex_Unlock(self->m_hGSListMutex);
if (MV_OSAL_CPU_LOCAL == MV_OSAL_CPU_MASTER)
goto MV_CC_DSS_Constructor_Exit;
// Check Remote CPU
res = MV_CC_StartStatus_Check();
if ((res == S_OK) || (res == MV_CC_STATUS_OK))
{
// Synchronize with Remote CPU
res = MV_CC_DSS_DSPSendTo( self,
self->m_RemoteCPU,
DSPPacket_HeadGEN(CMD_DSS_AskUpdate, 0, 0, 0),
NULL,
0);
if (res != S_OK)
MV_CC_DBG_Error(res, "MV_CC_DSS_Constructor Synchronize with Remote CPU (AskUpdate)", NULL);
}
MV_CC_DSS_Constructor_Exit:
pMV_APP_DSS = self;
return S_OK;
}
HRESULT MV_CC_DSS_DSPSendTo(pMV_CC_DSP_t self,
MV_OSAL_CPUID_U8_t DstCPU,
UINT32 Head,
UCHAR *pData,
UINT32 DataLen)
{
HRESULT res;
UCHAR MsgBuf[MV_CC_ICCFIFO_FRAME_SIZE];
UCHAR *pMsgBuf = MsgBuf;
/* Parameter Check */
if ((self == NULL) || (self->m_pICCNet == NULL) ||
(DstCPU >= MV_OSAL_CPU_NUM) ||
(DataLen > MV_CC_CCDSP_DATA_BYTESIZE) ||
((DataLen > 0) && (pData == NULL)))
MV_CC_DBG_Error(E_INVALIDARG, "MV_CC_DSS_DSPSendTo", NULL);
/* assemble ICCP Datagram */
ICCP_SrcCPU(pMsgBuf) = self->m_pICCNet->m_LocalCPU;
ICCP_SrcProcess(pMsgBuf) = MV_CC_PROCESS_ID_BROADCAST;
ICCP_DstCPU(pMsgBuf) = DstCPU;
ICCP_DstProcess(pMsgBuf) = MV_CC_PROCESS_ID_BROADCAST;
ICCP_DatagramID(pMsgBuf) = 0;
ICCP_Protocol(pMsgBuf) = MV_CC_Protocol_CCDSP;
ICCP_Padding(pMsgBuf) = 0xFF;
ICCP_TimeStamp(pMsgBuf) = 0x12345678;
/* assemble DSP Packet */
GaloisMemcpy(DSPPacket_HeadStart(pMsgBuf), (UCHAR *)(&Head), sizeof(Head));
if (DataLen > 0)
GaloisMemcpy(DSPPacket_DataStart(pMsgBuf), pData, DataLen);
//MV_CC_DBG_Info("(CPU-%d) sent DSP Parket CMD[%d] to (CPU-%d)\n",
// ICCP_SrcCPU(pMsgBuf),
// CCDSP_Command(pMsgBuf),
// ICCP_DstCPU(pMsgBuf));
/* Send a CC-DSP Packet*/
res = MV_CC_ICCNetWrite(self->m_pICCNet, pMsgBuf);
switch (res)
{
case S_OK:
self->m_WrCount++;
break;
case E_FULL:
self->m_WrErrCount++;
break;
default:
self->m_WrErrCount++;
MV_CC_DBG_Error(res, "MV_CC_DSS_DSPSendTo", NULL);
break;
}
return res;
}
HRESULT MV_CC_DSS_DSPOnRecvDemux(void *self, UCHAR *pFrameBuf)
{
HRESULT res = S_OK, i;
MV_OSAL_CPUID_U8_t DstCPU;
UINT8 Cmd, Param1;
pMV_CC_DSP_t pHandle;
pMV_CC_DSS_ServiceInfo_t pSrvInfo, pSrvInfo_copy;
/* Parameter Check */
if (((pHandle = (pMV_CC_DSP_t)self ) == NULL) ||
(pFrameBuf == NULL))
MV_CC_DBG_Error(E_NOTREADY, "MV_CC_DSS_DSPOnRecvDemux", NULL);
DstCPU = ICCP_SrcCPU(pFrameBuf);
Cmd = CCDSP_Command(pFrameBuf);
switch (Cmd)
{
case CMD_DSS_AskUpdate:
//if (DstCPU != MV_OSAL_CPU_LOCAL)
if (DstCPU == pHandle->m_RemoteCPU)
{
// Ask DSS_Update_Task to update with Remote CPU
//MV_OSAL_Sem_Post(pHandle->m_UpdateTaskSem);
res = DSS_Update(pHandle);
}
else
{
MV_CC_DBG_Warning(res, "MV_CC_DSS_DSPOnRecvDemux CMD_DSS_AskUpdate error", NULL);
res = E_FAIL;
}
break;
case CMD_DSS_UpdateOK:
MV_CC_DBG_Info("(CPU-%d)MV_CC_DSS_DSPOnRecvDemux CMD_DSS_UpdateOK from (CPU-%d)\n", MV_OSAL_CPU_LOCAL, DstCPU);
pHandle->m_bStatusUpdate = true;
res = S_OK;
// Only for test
//res = MV_CC_DSS_GlobalServiceList_Traversal(GSList_VisitFunc_Demo, NULL);
break;
case CMD_DSS_UpdateError:
MV_CC_DBG_Info("(CPU-%d)MV_CC_DSS_DSPOnRecvDemux CMD_DSS_UpdateError from (CPU-%d)\n", MV_OSAL_CPU_LOCAL, DstCPU);
//pHandle->m_bStatusUpdate = false;
res = S_OK;
break;
case CMD_DSS_Add:
Param1 = CCDSP_Param1(pFrameBuf);
i = 0;
while (i < Param1)
{
if ( (sizeof(MV_CC_DSS_ServiceInfo_t) * ( i + 1 )) > MV_CC_CCDSP_DATA_BYTESIZE)
{
res = E_OUTOFRANGE;
MV_CC_DBG_Warning(res, "MV_CC_DSS_DSPOnRecvDemux CMD_DSS_Add->Parameter 1", NULl);
break;
}
pSrvInfo = (pMV_CC_DSS_ServiceInfo_t)(DSPPacket_DataStart(pFrameBuf) + sizeof(MV_CC_DSS_ServiceInfo_t) * i);
pSrvInfo_copy = MV_CC_DSS_GlobalServiceList_SrvInfo_Ctor();
if (pSrvInfo_copy == NULL)
MV_CC_DBG_Error(E_OUTOFMEMORY, "MV_CC_DSS_DSPOnRecvDemux", NULL);
GaloisMemcpy(pSrvInfo_copy, pSrvInfo, sizeof(MV_CC_DSS_ServiceInfo_t));
MV_OSAL_Mutex_Lock(pHandle->m_hGSListMutex);
res = MV_CC_DSS_GlobalServiceList_Add(pSrvInfo->m_ServiceID, pSrvInfo_copy);
if (res != S_OK)
MV_CC_DBG_Warning(res, "MV_CC_DSS_DSPOnRecvDemux MV_CC_DSS_GlobalServiceList_Add", NULL);
// Only for test
//res = MV_CC_DSS_GlobalServiceList_Traversal(GSList_VisitFunc_Demo, NULL);
MV_OSAL_Mutex_Unlock(pHandle->m_hGSListMutex);
i++;
}
break;
case CMD_DSS_Delete:
Param1 = CCDSP_Param1(pFrameBuf);
i = 0;
while (i < Param1)
{
if ( (sizeof(MV_CC_DSS_ServiceInfo_t) * ( i + 1 )) > MV_CC_CCDSP_DATA_BYTESIZE)
{
res = E_OUTOFRANGE;
MV_CC_DBG_Warning(res, "MV_CC_DSS_DSPOnRecvDemux CMD_DSS_Delete->Parameter 1", NULL);
break;
}
pSrvInfo = (pMV_CC_DSS_ServiceInfo_t)(DSPPacket_DataStart(pFrameBuf) + sizeof(MV_CC_DSS_ServiceInfo_t) * i);
MV_OSAL_Mutex_Lock(pHandle->m_hGSListMutex);
res = MV_CC_DSS_GlobalServiceList_Delete(pSrvInfo->m_ServiceID);
if (res != S_OK)
MV_CC_DBG_Warning(res, "MV_CC_DSS_DSPOnRecvDemux MV_CC_DSS_GlobalServiceList_Delete", NULL);
// Only for test
//res = MV_CC_DSS_GlobalServiceList_Traversal(GSList_VisitFunc_Demo, NULL);
MV_OSAL_Mutex_Unlock(pHandle->m_hGSListMutex);
i++;
}
break;
default:
res = E_BADVALUE;
MV_CC_DBG_Warning(res, "MV_CC_DSS_DSPOnRecvDemux Error Command", NULL);
break;
}
if (res == S_OK)
pHandle->m_RdCount++;
else
pHandle->m_RdErrCount++;
return res;
}