31 lines
742 B
C
31 lines
742 B
C
#include "libultra_internal.h"
|
|
|
|
s32 osSendMesg(OSMesgQueue *mq, OSMesg msg, s32 flag) {
|
|
register u32 int_disabled;
|
|
register s32 index;
|
|
register OSThread *s2;
|
|
int_disabled = __osDisableInt();
|
|
|
|
while (mq->validCount >= mq->msgCount) {
|
|
if (flag == OS_MESG_BLOCK) {
|
|
D_803348A0->state = 8;
|
|
__osEnqueueAndYield(&mq->fullqueue);
|
|
} else {
|
|
__osRestoreInt(int_disabled);
|
|
return -1;
|
|
}
|
|
}
|
|
|
|
index = (mq->first + mq->validCount) % mq->msgCount;
|
|
mq->msg[index] = msg;
|
|
mq->validCount++;
|
|
|
|
if (mq->mtqueue->next != NULL) {
|
|
s2 = __osPopThread(&mq->mtqueue);
|
|
osStartThread(s2);
|
|
}
|
|
|
|
__osRestoreInt(int_disabled);
|
|
return 0;
|
|
}
|