PUBLIC void
ixOsalTicksToTimeval (UINT32 ticks, IxOsalTimeval * pTv)
{
UINT32 tickPerSecs = 0;
UINT32 nanoSecsPerTick = 0;
/*
* Reset the time value
*/
pTv->secs = 0;
pTv->nsecs = 0;
tickPerSecs = ixOsalSysClockRateGet ();
nanoSecsPerTick = IX_OSAL_BILLION / tickPerSecs;
/*
* value less than 1 sec
*/
if (tickPerSecs > ticks) /* value less then 1 sec */
{
pTv->nsecs = ticks * nanoSecsPerTick;
}
else
{
pTv->secs = ticks / tickPerSecs;
pTv->nsecs = (ticks % tickPerSecs) * nanoSecsPerTick;
}
}
IX_STATUS
ixOsalSemaphoreWait (IxOsalSemaphore * sid, INT32 timeout)
{
int retVal;
UINT32 ticks;
if ( (timeout == IX_OSAL_WAIT_FOREVER)
|| (timeout == IX_OSAL_WAIT_NONE))
{
retVal = semTake (*(SEM_ID *) sid, timeout);
}
else if (timeout > 0)
{
ticks = (ixOsalSysClockRateGet () * timeout) / 1000;
retVal = semTake (*(SEM_ID *) sid, ticks);
}
else
{
ixOsalLog (IX_OSAL_LOG_LVL_ERROR,
IX_OSAL_LOG_DEV_STDOUT,
"ixOsalSemaphoreWait(): Illegal timeout value. \n", 0, 0, 0, 0, 0, 0);
return IX_FAIL;
}
if (retVal != OK)
{
return IX_FAIL;
}
return IX_SUCCESS;
}
PUBLIC IX_STATUS
ixOsalMutexLock (IxOsalMutex * mutex, INT32 timeout)
{
UINT32 ticks;
if (timeout > 0)
{
ticks = (ixOsalSysClockRateGet () * timeout) / 1000;
return IX_OSAL_MAP_VX_RETCODE (semTake ((*mutex), (INT32) ticks));
}
else if (timeout == IX_OSAL_WAIT_FOREVER)
{
return IX_OSAL_MAP_VX_RETCODE (semTake ((*mutex), WAIT_FOREVER));
}
else if (timeout == IX_OSAL_WAIT_NONE)
{
return IX_OSAL_MAP_VX_RETCODE (semTake ((*mutex), NO_WAIT));
}
else
{
ixOsalLog (IX_OSAL_LOG_LVL_ERROR,
IX_OSAL_LOG_DEV_STDOUT,
"ixOsalMutexLock(): ERROR - wrong timeout value = %d \n",
timeout, 0, 0, 0, 0, 0);
return IX_FAIL;
}
}
PUBLIC UINT32
ixOsalTimevalToTicks (IxOsalTimeval tv)
{
UINT32 tickPerSecs = 0;
UINT32 nanoSecsPerTick = 0;
tickPerSecs = ixOsalSysClockRateGet ();
nanoSecsPerTick = IX_OSAL_BILLION / tickPerSecs;
return ((tv.secs * tickPerSecs) + (tv.nsecs / nanoSecsPerTick));
}
PUBLIC void
ixOsalSleep (UINT32 milliseconds)
{
UINT32 delay = (ixOsalSysClockRateGet () * milliseconds) / 1000;
/*
* Cover a rounding down to zero
*/
if (delay == 0 && milliseconds != 0)
++delay;
taskDelay (delay);
}
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;
}
