int timerLoop (void) { IxOsalTimeval now; IxOsalVoidFnVoidPtr callback = NULL; void *callbackParam = NULL; IxOsalTimerRec *nextTimer; IX_STATUS status; while (1) { /* * This loop catches all cases in a simple way. If multiple * timers expire together, then lowest will be <=0 until all * have been processed and the queue get won't get invoked. */ status = ixOsalSemaphoreWait (&ixOsalCriticalSectSem, IX_OSAL_WAIT_FOREVER); if (status != IX_SUCCESS) { ixOsalLog (IX_OSAL_LOG_LVL_ERROR, IX_OSAL_LOG_DEV_STDOUT, "timerLoop fail to get semaphore \n", 0, 0, 0, 0, 0, 0); return IX_FAIL; } ixOsalTimeGet (&now); nextTimer = findNextTimeout (now); if ((nextTimer == NULL) || IX_OSAL_TIME_GT ((nextTimer->expires), (now))) { callback = NULL; } else { rescheduleTimer (nextTimer); callback = nextTimer->callback; callbackParam = nextTimer->callbackParam; } status = ixOsalSemaphorePost (&ixOsalCriticalSectSem); if (status != IX_SUCCESS) { ixOsalLog (IX_OSAL_LOG_LVL_ERROR, IX_OSAL_LOG_DEV_STDOUT, "timerLoop fail to release semaphore \n", 0, 0, 0, 0, 0, 0); return IX_FAIL; } if (callback != NULL) { callTimerCallback (callback, callbackParam); } else { timerSleep (nextTimer, now); } } }
/** * @brief default NPE event processing callback * * @param npeID ID of the NPE that generated the event * @param msg NPE message (encapsulated event) * * Creates an event object on the Ethernet event processor queue * and signals the new event by incrementing the event queue semaphore. * Events are processed by @ref ixEthDBEventProcessorLoop() which runs * at user level. * * @see ixEthDBEventProcessorLoop() * * @warning do not call directly * * @internal */ IX_ETH_DB_PUBLIC void ixEthDBNPEEventCallback(IxNpeMhNpeId npeID, IxNpeMhMessage msg) { PortEvent *local_event; IX_ETH_DB_IRQ_EVENTS_TRACE("DB: (Events) new event received by processor callback from port %d, id 0x%X\n", IX_ETHNPE_NODE_AND_PORT_TO_PHYSICAL_ID(npeID,0), NPE_MSG_ID(msg), 0, 0, 0, 0); if (CAN_ENQUEUE(&eventQueue)) { TEST_FIXTURE_LOCK_EVENT_QUEUE; local_event = QUEUE_HEAD(&eventQueue); /* create event structure on queue */ local_event->eventType = NPE_MSG_ID(msg); local_event->portID = IX_ETHNPE_NODE_AND_PORT_TO_PHYSICAL_ID(npeID,0); /* update queue */ PUSH_UPDATE_QUEUE(&eventQueue); TEST_FIXTURE_UNLOCK_EVENT_QUEUE; IX_ETH_DB_IRQ_EVENTS_TRACE("DB: (Events) Waking up main processor loop...\n", 0, 0, 0, 0, 0, 0); /* increment event queue semaphore */ ixOsalSemaphorePost(&eventQueueSemaphore); } else { IX_ETH_DB_IRQ_EVENTS_TRACE("DB: (Events) Warning: could not enqueue event (overflow)\n", 0, 0, 0, 0, 0, 0); } }
PUBLIC IX_STATUS ixOsalTimerCancel (IxOsalTimer * timer) { UINT32 id; UINT32 i; IX_STATUS status = IX_FAIL; if (ixOsalTimerInited == FALSE) { ixOsalLog (IX_OSAL_LOG_LVL_ERROR, IX_OSAL_LOG_DEV_STDOUT, "ixOsalTimerCancel: call schedule APIs first to start timer \n", 0, 0, 0, 0, 0, 0); return IX_FAIL; } id = *timer; status = ixOsalSemaphoreWait (&ixOsalCriticalSectSem, IX_OSAL_WAIT_FOREVER); if (status != IX_SUCCESS) { ixOsalLog (IX_OSAL_LOG_LVL_ERROR, IX_OSAL_LOG_DEV_STDOUT, "ixOsalTimerCancel: fail to get semaphore \n", 0, 0, 0, 0, 0, 0); return IX_FAIL; } /* * NOTE : there is no need to get the timer callback thread to wake * up and recalculate. If this timer is the next to expire, then * the timer callback thread will wake up but not find any timers to * callback and will just go back to sleep again anyway. */ /* * NOTE2 : We cancel a timer by doing a linear search for the timer id. * This is not terribly efficient but is the safest way to ensure that * cancellations do not cancel the wrong timer by mistake. Also we * assume timer cancellation does not occur often. If the timer to * be cancelled is not found, an error is logged. */ for (i = 0; i < ixOsalHigestTimeSlotUsed; i++) { if (ixOsalTimers[i].inUse && ixOsalTimers[i].id == id) { ixOsalTimers[i].inUse = FALSE; break; } } status = ixOsalSemaphorePost (&ixOsalCriticalSectSem); if (status != IX_SUCCESS) { ixOsalLog (IX_OSAL_LOG_LVL_ERROR, IX_OSAL_LOG_DEV_STDOUT, "ixOsalTimerCancel: fail to free semaphore \n", 0, 0, 0, 0, 0, 0); return IX_FAIL; } return IX_SUCCESS; }
/** * @ingroup IxTimeSyncAccCodelet * * @fn ixTimeSyncAccCodeletTxDoneCB ( UINT32 cbTag, IX_OSAL_MBUF* mBufPtr, * * @brief Tx callback. This function gives semaphore to allow * ixTimeSyncAccCodeletPTPMsgTransmit function to transmit * next PTP message. * * @param * cbTag UINT32 [in] - argument passed to callback * * @param * mBufPtr IX_OSAL_MBUF* [in] - pointer to mBuf * * @return void */ PRIVATE void ixTimeSyncAccCodeletTxDoneCB ( UINT32 cbTag, IX_OSAL_MBUF* mBufPtr) { if (IX_SUCCESS != ixOsalSemaphorePost (&ixTimeSyncAccCodeletSemId)) { ixOsalLog (IX_OSAL_LOG_LVL_ERROR, IX_OSAL_LOG_DEV_STDERR, "ixTimeSyncAccCodeletTxDoneCB: Failed to give semaphore, port Id %d\n", cbTag, 0, 0, 0, 0, 0); } } /* end of ixTimeSyncAccCodeletTxDoneCB function */
/** * @brief stops the event processor * * Stops the event processor and frees the event queue semaphore * Called by the component de-initialization function, ixEthDBUnload() * * @warning do not call directly * * @return IX_ETH_DB_SUCCESS if the operation completed * successfully or IX_ETH_DB_FAIL otherwise; * * @internal */ IX_ETH_DB_PUBLIC IxEthDBStatus ixEthDBStopLearningFunction(void) { ixEthDBLearningShutdown = true; /* wake up event processing loop to actually process the shutdown event */ ixOsalSemaphorePost(&eventQueueSemaphore); if (ixOsalSemaphoreDestroy(&eventQueueSemaphore) != IX_SUCCESS) { return IX_ETH_DB_FAIL; } return IX_ETH_DB_SUCCESS; }
/** * @brief stops the event processor * * Stops the event processor and frees the event queue semaphore * Called by the component de-initialization function, ixEthDBUnload() * * @warning do not call directly * * @return IX_ETH_DB_SUCCESS if the operation completed * successfully or IX_ETH_DB_FAIL otherwise; * * @internal */ IX_ETH_DB_PUBLIC IxEthDBStatus ixEthDBStopLearningFunction(void) { if (IX_FEATURE_CTRL_SWCONFIG_ENABLED == ixFeatureCtrlSwConfigurationCheck (IX_FEATURECTRL_ETH_LEARNING)) { ixEthDBLearningShutdown = TRUE; /* wake up event processing loop to actually process the shutdown event */ ixOsalSemaphorePost(&eventQueueSemaphore); if (ixOsalSemaphoreDestroy(&eventQueueSemaphore) != IX_SUCCESS) { return IX_ETH_DB_FAIL; } return IX_ETH_DB_SUCCESS; } return IX_ETH_DB_FEATURE_UNAVAILABLE; }
/** * @brief adds an ADD or REMOVE event to the main event queue * * @param eventType event type - IX_ETH_DB_ADD_FILTERING_RECORD * to add and IX_ETH_DB_REMOVE_FILTERING_RECORD to remove a * record. * * @return IX_ETH_DB_SUCCESS if the event was successfully * sent or IX_ETH_DB_BUSY if the event queue is full * * @internal */ IX_ETH_DB_PRIVATE IxEthDBStatus ixEthDBTriggerPortUpdate(UINT32 eventType, IxEthDBMacAddr *macAddr, IxEthDBPortId portID, BOOL staticEntry) { UINT32 intLockKey; /* lock interrupts to protect queue */ intLockKey = ixOsalIrqLock(); if (CAN_ENQUEUE(&eventQueue)) { PortEvent *queueEvent = QUEUE_HEAD(&eventQueue); /* update fields on the queue */ ixOsalMemCopy(queueEvent->macAddr.macAddress, macAddr->macAddress, IX_IEEE803_MAC_ADDRESS_SIZE); queueEvent->eventType = eventType; queueEvent->portID = portID; queueEvent->staticEntry = staticEntry; PUSH_UPDATE_QUEUE(&eventQueue); /* imcrement event queue semaphore */ ixOsalSemaphorePost(&eventQueueSemaphore); /* unlock interrupts */ ixOsalIrqUnlock(intLockKey); return IX_ETH_DB_SUCCESS; } else /* event queue full */ { /* unlock interrupts */ ixOsalIrqUnlock(intLockKey); return IX_ETH_DB_BUSY; } }
PRIVATE void ixHssAccCodeletChanRxCallback ( IxHssAccHssPort hssPortId, unsigned rxOffset, unsigned txOffset, unsigned numHssErrs) { ClientInfo *pClientInfo = &clientInfo[hssPortId]; Message *pMessage; /* add message to the head of the message queue */ pMessage = &pClientInfo->messageQ[pClientInfo->qHead++]; pClientInfo->qHead %= NUMELEMS(pClientInfo->messageQ); /* fill in the message */ pMessage->type = RxCallback; pMessage->params.rxOffset = rxOffset; pMessage->params.txOffset = txOffset; pMessage->params.numHssErrs = numHssErrs; /* wake up the message processing thread */ (void) ixOsalSemaphorePost (&pClientInfo->messageSem); }
PUBLIC IX_STATUS ixOsalMutexUnlock (IxOsalMutex * mutex) { return ixOsalSemaphorePost((IxOsalSemaphore *) mutex); }
PRIVATE IX_STATUS createNewTimer (IxOsalVoidFnVoidPtr func, void *param, UINT32 priority, UINT32 interval, BOOL isRepeating, UINT32 * timerId) { UINT32 i; IX_STATUS status = IX_SUCCESS; int osTicks; IxOsalTimeval timeVal; /* * Check if callback is NULL */ if (func == NULL) { ixOsalLog (IX_OSAL_LOG_LVL_ERROR, IX_OSAL_LOG_DEV_STDOUT, "client registered a NULL callback function\n", 0, 0, 0, 0, 0, 0); return IX_FAIL; } osTicks = ixOsalSysClockRateGet (); /* * Figure out how many milisecond per tick and compare against interval */ if (interval < (UINT32) (1000 / osTicks)) { ixOsalLog (IX_OSAL_LOG_LVL_ERROR, IX_OSAL_LOG_DEV_STDOUT, "client requested time interval (%d) finer than clock ticks\n", interval, 0, 0, 0, 0, 0); return IX_FAIL; } /* * Increment timerId */ *timerId = ++lastTimerId; status = ixOsalSemaphoreWait (&ixOsalCriticalSectSem, IX_OSAL_WAIT_FOREVER); if (status != IX_SUCCESS) { ixOsalLog (IX_OSAL_LOG_LVL_ERROR, IX_OSAL_LOG_DEV_STDOUT, "createNewTimer fail to get semaphore \n", 0, 0, 0, 0, 0, 0); return IX_FAIL; } for (i = 0; i < IX_OSAL_MAX_TIMERS; i++) { if (!ixOsalTimers[i].inUse) { break; } } if ((i >= IX_OSAL_TIMER_WARNING_THRESHOLD) && (ixOsalThresholdErr == FALSE)) { /* * This error serves as an early indication that the number of * available timer slots will need to be increased. This is done * by increasing IX_OSAL_MAX_TIMERS */ ixOsalLog (IX_OSAL_LOG_LVL_WARNING, IX_OSAL_LOG_DEV_STDOUT, "Timer threshold reached. Only %d timer slots now available\n", IX_OSAL_MAX_TIMERS - i, 0, 0, 0, 0, 0); ixOsalThresholdErr = TRUE; } if (i == IX_OSAL_MAX_TIMERS) { /* * If you get this error, increase MAX_TIMERS above */ ixOsalLog (IX_OSAL_LOG_LVL_ERROR, IX_OSAL_LOG_DEV_STDOUT, "Out of timer slots %d used - request ignored\n", i, 0, 0, 0, 0, 0); status = IX_FAIL; } else { ixOsalTimers[i].inUse = TRUE; IX_OSAL_MS_TO_TIMEVAL (interval, &timeVal); ixOsalTimers[i].period = timeVal; ixOsalTimers[i].isRepeating = isRepeating; ixOsalTimeGet (&(ixOsalTimers[i].expires)); IX_OSAL_TIME_ADD ((ixOsalTimers[i].expires), (ixOsalTimers[i].period)) ixOsalTimers[i].priority = priority; ixOsalTimers[i].callback = func; ixOsalTimers[i].callbackParam = param; ixOsalTimers[i].id = *timerId; if ((i) >= ixOsalHigestTimeSlotUsed) { ixOsalHigestTimeSlotUsed = i + 1; } status = ixOsalSemaphorePost (&ixOsalTimerRecalcSem); if (status != IX_SUCCESS) { ixOsalLog (IX_OSAL_LOG_LVL_ERROR, IX_OSAL_LOG_DEV_STDOUT, "createNewTimer: fail to release semaphore \n", 0, 0, 0, 0, 0, 0); return IX_FAIL; } } status = ixOsalSemaphorePost (&ixOsalCriticalSectSem); if (status != IX_SUCCESS) { ixOsalLog (IX_OSAL_LOG_LVL_ERROR, IX_OSAL_LOG_DEV_STDOUT, "createNewTimer: fail to release semaphore: ixOsalCriticalSectSem \n", 0, 0, 0, 0, 0, 0); return IX_FAIL; } return status; }