u32_t
sys_arch_sem_wait(sys_sem_t Sema,u32_t u32Timeout)
{
//Wait u32Timeout msec for the Sema to receive a signal.
dbgprintf("sys_arch_sem_wait: Sema: %d, Timeout: %x (TID: %d)\n",Sema,u32Timeout,GetThreadId());
if(u32Timeout==0)
{
//Wait with no timeouts.
return WaitSema(Sema)==0 ? 0:SYS_ARCH_TIMEOUT;
}
else if(u32Timeout==1)
{
//Poll.
return PollSema(Sema)==0 ? 0:SYS_ARCH_TIMEOUT;
}
else
{
//Use alarm to timeout.
iop_sys_clock_t ClockTicks;
iop_sys_clock_t Start;
iop_sys_clock_t End;
int iPID=GetThreadId();
u32_t u32WaitTime;
GetSystemTime(&Start);
USec2SysClock(u32Timeout*1000,&ClockTicks);
SetAlarm(&ClockTicks,TimeoutHandler,(void*)iPID);
if(WaitSema(Sema)!=0)
{
return SYS_ARCH_TIMEOUT;
}
CancelAlarm(TimeoutHandler,(void*)iPID);
GetSystemTime(&End);
u32WaitTime=ComputeTimeDiff(&Start,&End);
return u32WaitTime<=u32Timeout ? u32WaitTime:u32Timeout;
}
}
static u32_t sys_arch_mbox_fetch_internal(sys_mbox_t pMBox, void** ppvMSG, u32_t TimeElaspedout, char block)
{
void *pmsg;
u32_t TimeElasped = 0;
iop_sys_clock_t ClockTicks;
iop_sys_clock_t Start;
iop_sys_clock_t End;
int result, iPID;
if(block){
iPID=GetThreadId();
if(TimeElaspedout > 0)
{
GetSystemTime(&Start);
USec2SysClock(TimeElaspedout * 1000, &ClockTicks);
SetAlarm(&ClockTicks, &TimeoutHandler, (void*)iPID);
}
if((result=ReceiveMbx(&pmsg, pMBox))!= 0) { return(SYS_ARCH_TIMEOUT); }
if(TimeElaspedout > 0)
{
CancelAlarm(TimeoutHandler,(void*)iPID);
GetSystemTime(&End);
TimeElasped = ComputeTimeDiff(&Start, &End);
}
}
else{
TimeElasped=((result=PollMbx(&pmsg, pMBox))!=0)?SYS_MBOX_EMPTY:0;
}
if(result==0){
*ppvMSG = ((arch_message *)pmsg)->sys_msg;
free_msg((arch_message *) pmsg);
}
//Return the number of msec waited.
return TimeElasped;
}
void
thread_main(void *nuttin)
{
struct timeval tv1, tv2;
double delay;
printf("Starting benchmark: \n");
fflush(stdout);
/* Install Signal Handlers */
signal(SIGALRM, alarmsig);
signal(SIGINT, intsig);
signal(SIGSEGV, segsig);
signal(SIGUSR1, siguser);
while (1) {
mutex_lock(&mx_go);
cond_wait(&cond_go, &mx_go);
mutex_unlock(&mx_go);
gettimeofday(&tv1, 0);
if (bmark.testType == 0)
bmark_user_run();
else
bmark_fast_run();
gettimeofday(&tv2, 0);
ComputeTimeDiff(&delay, &tv1, &tv2);
#if 0
if (delay > 1.0)
printf("*");
else
printf(".");
#endif
printf("Time: %6.2f.\n", delay);
fflush(stdout);
}
}
u32_t sys_arch_sem_wait(sys_sem_t *sem, u32_t timeout)
{
//Wait TimeElaspedout msec for the Sema to receive a signal.
dbgprintf("sys_arch_sem_wait: Sema: %d, Timeout: %x (TID: %d)\n", *sem, timeout, GetThreadId());
u32_t result;
if(timeout==0)
{
//Wait with no timeouts.
result=(WaitSema(*sem)==0)?0:SYS_ARCH_TIMEOUT;
}
else if(timeout==1)
{
//Poll.
result=(PollSema(*sem)==0)?0:SYS_ARCH_TIMEOUT;
}
else
{
//Use alarm to timeout.
iop_sys_clock_t ClockTicks;
iop_sys_clock_t Start;
iop_sys_clock_t End;
int iPID=GetThreadId();
u32_t u32WaitTime;
GetSystemTime(&Start);
USec2SysClock(timeout*1000,&ClockTicks);
SetAlarm(&ClockTicks, &TimeoutHandler, (void*)iPID);
if(WaitSema(*sem)==0){
CancelAlarm(TimeoutHandler,(void*)iPID);
GetSystemTime(&End);
u32WaitTime=ComputeTimeDiff(&Start, &End);
result=(u32WaitTime<=timeout)?u32WaitTime:timeout;
}else result=SYS_ARCH_TIMEOUT;
}
return result;
}
u32_t
sys_arch_mbox_fetch(sys_mbox_t pMBox,void** ppvMSG,u32_t u32Timeout)
{
void *pmsg;
u32 u32Time = 0;
iop_sys_clock_t ClockTicks;
iop_sys_clock_t Start;
iop_sys_clock_t End;
if(PollMbx(&pmsg, pMBox) != 0)
{
int iPID=GetThreadId();
if(u32Timeout > 0)
{
GetSystemTime(&Start);
USec2SysClock(u32Timeout * 1000, &ClockTicks);
SetAlarm(&ClockTicks, TimeoutHandler, (void*)iPID);
}
if(ReceiveMbx(&pmsg, pMBox) != 0) { return(SYS_ARCH_TIMEOUT); }
if(u32Timeout > 0)
{
CancelAlarm(TimeoutHandler,(void*)iPID);
GetSystemTime(&End);
u32Time = ComputeTimeDiff(&Start,&End);
}
}
if(ppvMSG) { *ppvMSG = ((arch_message *) pmsg)->sys_msg; }
free_msg((arch_message *) pmsg);
//Return the number of msec waited.
return u32Time;
}
