/*
* ======== syslink_frameq_delete ========
*/
int syslink_frameq_delete(
resmgr_context_t * ctp,
io_devctl_t * msg,
syslink_ocb_t * ocb)
{
FrameQDrv_CmdArgs * cargs;
FrameQ_Handle * handlePtr;
GateMP_Handle gate;
cargs = (FrameQDrv_CmdArgs *)(_DEVCTL_DATA(msg->i));
handlePtr = (FrameQ_Handle *)(&cargs->args.deleteInstance.handle);
/* save gate handle, need to close it after delete */
gate = FrameQ_getGate(*handlePtr);
/* invoke the requested api */
cargs->apiStatus = FrameQ_delete(handlePtr);
GT_assert(curTrace, (cargs->apiStatus >= 0));
/* close the gate instance if not the default gate */
if (gate != GateMP_getDefaultRemote()) {
GateMP_close(&gate);
}
/* clear the return message, setup return values */
memset(&msg->o, 0, sizeof(msg->o));
msg->o.nbytes = sizeof(FrameQDrv_CmdArgs);
return(_RESMGR_PTR(ctp, &msg->o, sizeof(msg->o) + msg->o.nbytes));
}
/*
* ======== syslink_heapbufmp_delete ========
*/
int syslink_heapbufmp_delete(
resmgr_context_t * ctp,
io_devctl_t * msg,
syslink_ocb_t * ocb)
{
HeapBufMPDrv_CmdArgs * cargs;
HeapBufMP_Handle * handlePtr;
GateMP_Handle gate;
Int status;
/* extract input data */
cargs = (HeapBufMPDrv_CmdArgs *)(_DEVCTL_DATA(msg->i));
handlePtr = (HeapBufMP_Handle *)(&cargs->args.deleteInstance.handle);
/* save gate handle, need to close it after delete */
gate = HeapBufMP_getGate(*handlePtr);
/* remove object from cleanup list */
remove_ocb_res(ocb, DCMD_HEAPBUFMP_DELETE, (int)(*handlePtr), NULL);
/* invoke the requested api */
status = HeapBufMP_delete(handlePtr);
/* close the gate instance if not the default gate */
if (gate != GateMP_getDefaultRemote()) {
GateMP_close(&gate);
}
/* clear the return message, setup return values */
memset(&msg->o, 0, sizeof(msg->o));
msg->o.nbytes = sizeof(HeapBufMPDrv_CmdArgs);
cargs->apiStatus = status;
return(_RESMGR_PTR(ctp, &msg->o, sizeof(msg->o) + msg->o.nbytes));
}
/*
* ======== SemaphoreMP_Instance_finalize ========
*/
Void SemaphoreMP_Instance_finalize(SemaphoreMP_Object *obj, Int status)
{
if (obj->objType & (ti_sdo_ipc_Ipc_ObjType_CREATEDYNAMIC |
ti_sdo_ipc_Ipc_ObjType_CREATEDYNAMIC_REGION)) {
/* SemaphoreMP is being deleted */
/* Remove entry from NameServer */
if (obj->nsKey != NULL) {
NameServer_removeEntry((NameServer_Handle)
SemaphoreMP_module->nameServer, obj->nsKey);
}
/* Set status to 'not created' */
obj->attrs->status = 0;
if (obj->cacheEnabled) {
Cache_wbInv(obj->attrs, sizeof(SemaphoreMP_Attrs),
Cache_Type_ALL, TRUE);
}
/* Delete the pendQ. If NULL, then ListMP_create failed. */
if (obj->pendQ != NULL) {
ListMP_delete((ListMP_Handle *)&(obj->pendQ));
}
/*
* Free the shared memory back to the region SemaphoreMP. If NULL, then
* the Memory_alloc failed.
*/
if (obj->objType == ti_sdo_ipc_Ipc_ObjType_CREATEDYNAMIC_REGION &&
obj->attrs != NULL) {
Memory_free(SharedRegion_getHeap(obj->regionId), obj->attrs,
obj->allocSize);
}
}
else {
/* SemaphoreMP is being closed */
/* Close the pendQ. If NULL, then ListMP_openByAddr failed. */
if (obj->pendQ != NULL) {
ListMP_close((ListMP_Handle *)&(obj->pendQ));
}
/* Close the gate. If NULL, then GateMP_openByAddr failed. */
if (obj->gate != NULL) {
GateMP_close((GateMP_Handle *)&(obj->gate));
}
}
}
Int32 AVSYNC_DeInit()
{
Int32 status = 0;
AVSYNC_AvSyncEnable_t AVSYNC_AvSyncEnable;
AVSYNC_AvSyncEnable.avSyncCompEnable = FALSE;
AVSYNC_Control(AVSync_ComponentEnable, &AVSYNC_AvSyncEnable );
#ifdef ENABLE_AVSYNC_STATS_LOG
avsyncLogThr_exit = 1;
AVSYNC_LogThrDelete ();
#endif
if(pAvSyncInfo_obj != NULL)
{
status = GateMP_close ( pAvsyncMPGate);
pAvSyncInfo_obj = NULL;
}
return OSA_SOK;
}
/*
* ======== Server_exec ========
*/
Int Server_exec()
{
Int status;
GateMPApp_Msg * msg;
MessageQ_QueueId queId;
UInt32 physAddr;
volatile UInt32 * intPtr = 0;
Int num = 0;
Int prevNum = 0;
UInt i = 0;
IArg gateKey = 0;
Log_print0(Diags_ENTRY | Diags_INFO, "--> Server_exec:");
/* wait for inbound message */
status = MessageQ_get(Module.slaveQue, (MessageQ_Msg *)&msg,
MessageQ_FOREVER);
if (status < 0) {
goto leave;
}
if (msg->cmd != GATEMPAPP_CMD_SPTR_ADDR) {
status = GATEMPAPP_E_UNEXPECTEDMSG;
goto leave;
}
/* Get physical address of shared memory */
physAddr = msg->payload;
/* translate the physical address to slave virtual addr */
if (Resource_physToVirt(physAddr, (UInt32 *)&intPtr)) {
Log_error1("Server_exec: Failed to translate phys addr %p to virt addr", physAddr);
goto leave;
}
/* send message back */
queId = MessageQ_getReplyQueue(msg); /* type-cast not needed */
msg->cmd = GATEMPAPP_CMD_SPTR_ADDR_ACK;
MessageQ_put(queId, (MessageQ_Msg)msg);
Log_print0(Diags_INFO,"Server_exec: Modifying shared variable "
"value");
/* open host-created GateMP */
do {
status = GateMP_open(GATEMP_HOST_NAME, &Module.hostGateMPHandle);
} while (status == GateMP_E_NOTFOUND);
if (status < 0) {
Log_error0("Server_exec: Failed to open host-created GateMP");
status = GATEMPAPP_E_FAILURE;
goto leave;
}
Log_print0(Diags_INFO,"Server_exec: Opened GateMP successfully");
Log_print0(Diags_INFO,"Server_exec: Using host-created gate");
for (i = 0;i < LOOP_ITR; i++) {
/* modify the shared variable as long as no one else is currently
* accessing it
*/
/* enter GateMP */
gateKey = GateMP_enter(Module.hostGateMPHandle);
/* read shared variable value */
prevNum = *intPtr;
/* randomly modify the shared variable */
if ( rand() % 2) {
*intPtr -= 1;
}
else {
*intPtr += 1;
}
/* read shared variable value again */
num = *intPtr;
if ((prevNum != num + 1) && (prevNum != num - 1)) {
Log_print0(Diags_INFO, "Server_exec: unexpected variable value." \
"Test failed.");
Log_print2(Diags_INFO, "Server_exec: Previous shared variable "
"value %d, current value=%d", prevNum, num);
status = GATEMPAPP_E_FAILURE;
goto leave;
}
/* leave Gate */
GateMP_leave(Module.hostGateMPHandle, gateKey);
}
/* wait for sync message before we switch gates */
status = MessageQ_get(Module.slaveQue, (MessageQ_Msg *)&msg,
MessageQ_FOREVER);
if (status < 0) {
goto leave;
}
if (msg->cmd != GATEMPAPP_CMD_SYNC) {
status = GATEMPAPP_E_UNEXPECTEDMSG;
goto leave;
}
queId = MessageQ_getReplyQueue(msg);
MessageQ_put(queId, (MessageQ_Msg)msg);
Log_print0(Diags_INFO,"Server_exec: Using slave-created gate");
for (i = 0;i < LOOP_ITR; i++) {
/* modify the shared variable as long as no one else is currently
* accessing it
*/
/* enter GateMP */
gateKey = GateMP_enter(Module.slaveGateMPHandle);
/* read shared variable value */
prevNum = *intPtr;
/* randomly modify the shared variable */
if ( rand() % 2) {
*intPtr -= 1;
}
else {
*intPtr += 1;
}
/* read shared variable value again */
num = *intPtr;
if ((prevNum != num - 1) && (prevNum != num + 1)) {
Log_print0(Diags_INFO, "Server_exec: unexpected variable value." \
"Test failed.");
Log_print2(Diags_INFO, "Server_exec: Previous "
"value=%d, current value=%d", prevNum, num);
status = GATEMPAPP_E_FAILURE;
goto leave;
}
/* leave Gate */
GateMP_leave(Module.slaveGateMPHandle, gateKey);
}
leave:
/* close host GateMP */
if (Module.hostGateMPHandle) {
GateMP_close(&Module.hostGateMPHandle);
}
Log_print0(Diags_ENTRY, "Server_exec: host GateMP closed");
Log_print1(Diags_EXIT, "<-- Server_exec: %d", (IArg)status);
return(status);
}
/*
* ======== TransportShm_Instance_finalize ========
*/
Void TransportShm_Instance_finalize(TransportShm_Object* obj, Int status)
{
Swi_Handle swiHandle;
if (obj->objType == ti_sdo_ipc_Ipc_ObjType_CREATEDYNAMIC) {
/* clear the self flag */
obj->self->flag = 0;
if (obj->cacheEnabled) {
Cache_wbInv(&(obj->self->flag),
SharedRegion_getCacheLineSize(obj->regionId), Cache_Type_ALL,
TRUE);
}
if (obj->localList != NULL) {
ListMP_delete((ListMP_Handle *)&(obj->localList));
}
if (obj->remoteList != NULL) {
ListMP_delete((ListMP_Handle *)&(obj->remoteList));
}
}
else {
/* other flag was set by remote proc */
obj->other->flag = 0;
if (obj->cacheEnabled) {
Cache_wbInv(&(obj->other->flag),
SharedRegion_getCacheLineSize(obj->regionId), Cache_Type_ALL,
TRUE);
}
if (obj->gate != NULL) {
GateMP_close((GateMP_Handle *)&(obj->gate));
}
if (obj->localList != NULL) {
ListMP_close((ListMP_Handle *)&(obj->localList));
}
if (obj->remoteList != NULL) {
ListMP_close((ListMP_Handle *)&(obj->remoteList));
}
}
switch(status) {
case 0:
/* MessageQ_registerTransport succeeded */
ti_sdo_ipc_MessageQ_unregisterTransport(obj->remoteProcId, obj->priority);
/* OK to fall through */
case 1: /* GateMP open failed */
case 2: /* ListMP create/open failed */
case 3: /* Notify_registerEventSingle failed */
case 4: /* MessageQ_registerTransport failed */
Notify_unregisterEventSingle(
obj->remoteProcId,
0,
TransportShm_notifyEventId);
break;
}
/* Destruct the swi */
swiHandle = TransportShm_Instance_State_swiObj(obj);
if (swiHandle != NULL) {
Swi_destruct(Swi_struct(swiHandle));
}
}
