Function osRtxMessageQueuePostProcess

source/rtos2/RTX/Source/rtx_msgqueue.c:163–231

Message Queue post ISR processing. \param[in] msg message object.

/// Message Queue post ISR processing.
/// \param[in]  msg             message object.
static void osRtxMessageQueuePostProcess (os_message_t *msg) {
  os_message_queue_t *mq;
  os_message_t       *msg0;
  os_thread_t        *thread;
  const uint32_t     *reg;
  const void         *ptr_src;
        void         *ptr_dst;

  if (msg->flags != 0U) {
    // Remove Message
    //lint -e{9079} -e{9087} "cast between pointers to different object types"
    mq = *((os_message_queue_t **)(void *)&msg[1]);
    MessageQueueRemove(mq, msg);
    // Free memory
    msg->id = osRtxIdInvalid;
    (void)osRtxMemoryPoolFree(&mq->mp_info, msg);
    // Check if Thread is waiting to send a Message
    if (mq->thread_list != NULL) {
      // Try to allocate memory
      //lint -e{9079} "conversion from pointer to void to pointer to other type" [MISRA Note 5]
      msg0 = osRtxMemoryPoolAlloc(&mq->mp_info);
      if (msg0 != NULL) {
        // Wakeup waiting Thread with highest Priority
        thread = osRtxThreadListGet(osRtxObject(mq));
        osRtxThreadWaitExit(thread, (uint32_t)osOK, FALSE);
        // Copy Message (R2: const void *msg_ptr, R3: uint8_t msg_prio)
        reg = osRtxThreadRegPtr(thread);
        //lint -e{923} "cast from unsigned int to pointer"
        ptr_src = (const void *)reg[2];
        memcpy(&msg0[1], ptr_src, mq->msg_size);
        // Store Message into Queue
        msg0->id       = osRtxIdMessage;
        msg0->flags    = 0U;
        msg0->priority = (uint8_t)reg[3];
        MessageQueuePut(mq, msg0);
        EvrRtxMessageQueueInserted(mq, ptr_src);
      }
    }
  } else {
    // New Message
    //lint -e{9079} -e{9087} "cast between pointers to different object types"
    mq = (void *)msg->next;
    //lint -e{9087} "cast between pointers to different object types"
    ptr_src = (const void *)msg->prev;
    // Check if Thread is waiting to receive a Message
    if ((mq->thread_list != NULL) && (mq->thread_list->state == osRtxThreadWaitingMessageGet)) {
      EvrRtxMessageQueueInserted(mq, ptr_src);
      // Wakeup waiting Thread with highest Priority
      thread = osRtxThreadListGet(osRtxObject(mq));
      osRtxThreadWaitExit(thread, (uint32_t)osOK, FALSE);
      // Copy Message (R2: void *msg_ptr, R3: uint8_t *msg_prio)
      reg = osRtxThreadRegPtr(thread);
      //lint -e{923} "cast from unsigned int to pointer"
      ptr_dst = (void *)reg[2];
      memcpy(ptr_dst, &msg[1], mq->msg_size);
      if (reg[3] != 0U) {
        //lint -e{923} -e{9078} "cast from unsigned int to pointer"
        *((uint8_t *)reg[3]) = msg->priority;