| 80 | } |
| 81 | |
| 82 | sint32 OSSendMessage(OSMessageQueue* msgQueue, OSMessage* msg, uint32 flags) |
| 83 | { |
| 84 | __OSLockScheduler(); |
| 85 | while (msgQueue->usedCount >= msgQueue->msgCount) |
| 86 | { |
| 87 | if ((flags & OS_MESSAGE_BLOCK)) |
| 88 | { |
| 89 | msgQueue->threadQueueSend.queueAndWait(OSGetCurrentThread()); |
| 90 | } |
| 91 | else |
| 92 | { |
| 93 | __OSUnlockScheduler(); |
| 94 | return 0; |
| 95 | } |
| 96 | } |
| 97 | // add message |
| 98 | if ((flags & OS_MESSAGE_HIGH_PRIORITY)) |
| 99 | { |
| 100 | // decrease firstIndex |
| 101 | sint32 newFirstIndex = (sint32)((sint32)msgQueue->firstIndex + (sint32)msgQueue->msgCount - 1) % (sint32)msgQueue->msgCount; |
| 102 | msgQueue->firstIndex = newFirstIndex; |
| 103 | // insert message at new first index |
| 104 | msgQueue->usedCount = (uint32)msgQueue->usedCount + 1; |
| 105 | OSMessage* newMsg = &(msgQueue->msgArray[newFirstIndex]); |
| 106 | memcpy(newMsg, msg, sizeof(OSMessage)); |
| 107 | } |
| 108 | else |
| 109 | { |
| 110 | sint32 messageIndex = (uint32)(msgQueue->firstIndex + msgQueue->usedCount) % (uint32)msgQueue->msgCount; |
| 111 | msgQueue->usedCount = (uint32)msgQueue->usedCount + 1; |
| 112 | OSMessage* newMsg = &(msgQueue->msgArray[messageIndex]); |
| 113 | memcpy(newMsg, msg, sizeof(OSMessage)); |
| 114 | } |
| 115 | // wake up any thread waiting to read a message |
| 116 | if (!msgQueue->threadQueueReceive.isEmpty()) |
| 117 | msgQueue->threadQueueReceive.wakeupSingleThreadWaitQueue(true); |
| 118 | __OSUnlockScheduler(); |
| 119 | return 1; |
| 120 | } |
| 121 | |
| 122 | OSMessageQueue* OSGetSystemMessageQueue() |
| 123 | { |
no test coverage detected