32 lines
724 B
C
32 lines
724 B
C
#include <ultra64.h>
|
|
#include "osint.h"
|
|
|
|
s32 osSendMesg(OSMesgQueue *mq, OSMesg msg, s32 flags)
|
|
{
|
|
register u32 saveMask;
|
|
register s32 last;
|
|
saveMask = __osDisableInt();
|
|
while (MQ_IS_FULL(mq))
|
|
{
|
|
if (flags == OS_MESG_BLOCK)
|
|
{
|
|
__osRunningThread->state = OS_STATE_WAITING;
|
|
__osEnqueueAndYield(&mq->fullqueue);
|
|
}
|
|
else
|
|
{
|
|
__osRestoreInt(saveMask);
|
|
return -1;
|
|
}
|
|
}
|
|
last = (mq->first + mq->validCount) % mq->msgCount;
|
|
mq->msg[last] = msg;
|
|
mq->validCount++;
|
|
if (mq->mtqueue->next != NULL)
|
|
{
|
|
osStartThread(__osPopThread(&mq->mtqueue));
|
|
}
|
|
__osRestoreInt(saveMask);
|
|
return 0;
|
|
}
|