FreeCalypso > hg > freecalypso-sw
diff nuc-fw/nucleus/mbc.c @ 79:947b1f473960
beginning of nuc-fw
| author | Michael Spacefalcon <msokolov@ivan.Harhan.ORG> |
|---|---|
| date | Sun, 11 Aug 2013 07:17:25 +0000 |
| parents | |
| children |
line wrap: on
line diff
--- /dev/null Thu Jan 01 00:00:00 1970 +0000 +++ b/nuc-fw/nucleus/mbc.c Sun Aug 11 07:17:25 2013 +0000 @@ -0,0 +1,992 @@ +/*************************************************************************/ +/* */ +/* Copyright Mentor Graphics Corporation 2002 */ +/* All Rights Reserved. */ +/* */ +/* THIS WORK CONTAINS TRADE SECRET AND PROPRIETARY INFORMATION WHICH IS */ +/* THE PROPERTY OF MENTOR GRAPHICS CORPORATION OR ITS LICENSORS AND IS */ +/* SUBJECT TO LICENSE TERMS. */ +/* */ +/*************************************************************************/ + +/*************************************************************************/ +/* */ +/* FILE NAME VERSION */ +/* */ +/* mbc.c Nucleus PLUS 1.14 */ +/* */ +/* COMPONENT */ +/* */ +/* MB - Mailbox Management */ +/* */ +/* DESCRIPTION */ +/* */ +/* This file contains the core routines for the Mailbox management */ +/* component. */ +/* */ +/* DATA STRUCTURES */ +/* */ +/* None */ +/* */ +/* FUNCTIONS */ +/* */ +/* MBC_Create_Mailbox Create a mailbox */ +/* MBC_Delete_Mailbox Delete a mailbox */ +/* MBC_Send_To_Mailbox Send a mailbox message */ +/* MBC_Receive_From_Mailbox Receive a mailbox message */ +/* MBC_Cleanup Cleanup on timeout or a */ +/* terminate condition */ +/* */ +/* DEPENDENCIES */ +/* */ +/* cs_extr.h Common Service functions */ +/* tc_extr.h Thread Control functions */ +/* mb_extr.h Mailbox functions */ +/* hi_extr.h History functions */ +/* */ +/* HISTORY */ +/* */ +/* DATE REMARKS */ +/* */ +/* 03-01-1993 Created initial version 1.0 */ +/* 04-19-1993 Verified version 1.0 */ +/* 08-09-1993 Corrected pointer retrieval */ +/* loop, resulting in version 1.0a */ +/* 08-09-1993 Verified version 1.0a */ +/* 03-01-1994 Moved non-core functions into */ +/* supplemental files, changed */ +/* function interfaces to match */ +/* those in prototype, added */ +/* register options, changed */ +/* protection logic to reduce */ +/* overhead, resulting in */ +/* version 1.1 */ +/* */ +/* 03-18-1994 Verified version 1.1 */ +/* 04-17-1996 updated to version 1.2 */ +/* 03-24-1998 Released version 1.3 */ +/* 03-26-1999 Released 1.11m (new release */ +/* numbering scheme) */ +/* 04-17-2002 Released version 1.13m */ +/* 11-07-2002 Released version 1.14 */ +/*************************************************************************/ +#define NU_SOURCE_FILE + + +#include "cs_extr.h" /* Common service functions */ +#include "tc_extr.h" /* Thread control functions */ +#include "mb_extr.h" /* Mailbox functions */ +#include "hi_extr.h" /* History functions */ +#include "profiler.h" /* ProView interface */ + +/* Define external inner-component global data references. */ + +extern CS_NODE *MBD_Created_Mailboxes_List; +extern UNSIGNED MBD_Total_Mailboxes; +extern TC_PROTECT MBD_List_Protect; + + +/* Define internal component function prototypes. */ + +VOID MBC_Cleanup(VOID *information); + + +/*************************************************************************/ +/* */ +/* FUNCTION */ +/* */ +/* MBC_Create_Mailbox */ +/* */ +/* DESCRIPTION */ +/* */ +/* This function creates a mailbox and then places it on the list */ +/* of created mailboxes. */ +/* */ +/* CALLED BY */ +/* */ +/* Application */ +/* MBCE_Create_Mailbox Error checking shell */ +/* */ +/* CALLS */ +/* */ +/* CSC_Place_On_List Add node to linked-list */ +/* [HIC_Make_History_Entry] Make entry in history log */ +/* [TCT_Check_Stack] Stack checking function */ +/* TCT_Protect Data structure protect */ +/* TCT_Unprotect Un-protect data structure */ +/* */ +/* INPUTS */ +/* */ +/* mailbox_ptr Mailbox control block pointer*/ +/* name Mailbox name */ +/* suspend_type Suspension type */ +/* */ +/* OUTPUTS */ +/* */ +/* NU_SUCCESS */ +/* */ +/* HISTORY */ +/* */ +/* DATE REMARKS */ +/* */ +/* 03-01-1993 Created initial version 1.0 */ +/* 04-19-1993 Verified version 1.0 */ +/* 03-01-1994 Changed function interface to */ +/* match the prototype, added */ +/* register variable logic, */ +/* resulting in version 1.1 */ +/* */ +/* 03-18-1994 Verified version 1.1 */ +/* */ +/*************************************************************************/ +STATUS MBC_Create_Mailbox(NU_MAILBOX *mailbox_ptr, CHAR *name, + OPTION suspend_type) +{ + +R1 MB_MCB *mailbox; /* Mailbox control block ptr */ +INT i; /* Working index variable */ +NU_SUPERV_USER_VARIABLES + + /* Switch to supervisor mode */ + NU_SUPERVISOR_MODE(); + + /* Move input mailbox pointer into internal pointer. */ + mailbox = (MB_MCB *) mailbox_ptr; + +#ifdef NU_ENABLE_STACK_CHECK + + /* Call stack checking function to check for an overflow condition. */ + TCT_Check_Stack(); + +#endif + +#ifdef NU_ENABLE_HISTORY + + /* Make an entry that corresponds to this function in the system history + log. */ + HIC_Make_History_Entry(NU_CREATE_MAILBOX_ID, (UNSIGNED) mailbox, + (UNSIGNED) name, (UNSIGNED) suspend_type); + +#endif + + /* First, clear the mailbox ID just in case it is an old Mailbox + Control Block. */ + mailbox -> mb_id = 0; + + /* Fill in the mailbox name. */ + for (i = 0; i < NU_MAX_NAME; i++) + mailbox -> mb_name[i] = name[i]; + + /* Clear the message present flag- initial it to "no message present." */ + mailbox -> mb_message_present = NU_FALSE; + + /* Setup the mailbox suspension type. */ + if (suspend_type == NU_FIFO) + + /* FIFO suspension is selected, setup the flag accordingly. */ + mailbox -> mb_fifo_suspend = NU_TRUE; + else + + /* Priority suspension is selected. */ + mailbox -> mb_fifo_suspend = NU_FALSE; + + /* Clear the suspension list pointer. */ + mailbox -> mb_suspension_list = NU_NULL; + + /* Clear the number of tasks waiting on the mailbox counter. */ + mailbox -> mb_tasks_waiting = 0; + + /* Initialize link pointers. */ + mailbox -> mb_created.cs_previous = NU_NULL; + mailbox -> mb_created.cs_next = NU_NULL; + + /* Protect against access to the list of created mailboxes. */ + TCT_Protect(&MBD_List_Protect); + + /* At this point the mailbox is completely built. The ID can now be + set and it can be linked into the created mailbox list. */ + mailbox -> mb_id = MB_MAILBOX_ID; + + /* Link the mailbox into the list of created mailboxes and increment the + total number of mailboxes in the system. */ + CSC_Place_On_List(&MBD_Created_Mailboxes_List, &(mailbox -> mb_created)); + MBD_Total_Mailboxes++; + +#ifdef INCLUDE_PROVIEW + _RTProf_DumpMailBox(RT_PROF_CREATE_MAILBOX,mailbox,RT_PROF_OK); +#endif /* INCLUDE_PROVIEW */ + /* Release protection against access to the list of created mailboxes. */ + TCT_Unprotect(); + + /* Return to user mode */ + NU_USER_MODE(); + + /* Return successful completion. */ + return(NU_SUCCESS); +} + + +/*************************************************************************/ +/* */ +/* FUNCTION */ +/* */ +/* MBC_Delete_Mailbox */ +/* */ +/* DESCRIPTION */ +/* */ +/* This function deletes a mailbox and removes it from the list of */ +/* created mailboxes. All tasks suspended on the mailbox are */ +/* resumed. Note that this function does not free the memory */ +/* associated with the mailbox control block. */ +/* */ +/* CALLED BY */ +/* */ +/* Application */ +/* MBCE_Delete_Mailbox Error checking shell */ +/* */ +/* CALLS */ +/* */ +/* CSC_Remove_From_List Remove node from list */ +/* [HIC_Make_History_Entry] Make entry in history log */ +/* TCC_Resume_Task Resume a suspended task */ +/* [TCT_Check_Stack] Stack checking function */ +/* TCT_Control_To_System Transfer control to system */ +/* TCT_Protect Protect created list */ +/* TCT_Set_Current_Protect Setup current protection ptr */ +/* TCT_System_Protect Protect against system access*/ +/* TCT_System_Unprotect Release system protection */ +/* TCT_Unprotect Release protection */ +/* */ +/* INPUTS */ +/* */ +/* mailbox_ptr Mailbox control block pointer*/ +/* */ +/* OUTPUTS */ +/* */ +/* NU_SUCCESS */ +/* */ +/* HISTORY */ +/* */ +/* DATE REMARKS */ +/* */ +/* 03-01-1993 Created initial version 1.0 */ +/* 04-19-1993 Verified version 1.0 */ +/* 03-01-1994 Changed function interface to */ +/* match the prototype, added */ +/* register variable logic, */ +/* optimized protection logic, */ +/* resulting in version 1.1 */ +/* */ +/* 03-18-1994 Verified version 1.1 */ +/* */ +/*************************************************************************/ +STATUS MBC_Delete_Mailbox(NU_MAILBOX *mailbox_ptr) +{ + +R1 MB_MCB *mailbox; /* Mailbox control block ptr */ +MB_SUSPEND *suspend_ptr; /* Suspend block pointer */ +MB_SUSPEND *next_ptr; /* Next suspend block pointer*/ +STATUS preempt; /* Status for resume call */ +NU_SUPERV_USER_VARIABLES + + /* Switch to supervisor mode */ + NU_SUPERVISOR_MODE(); + + /* Move input mailbox pointer into internal pointer. */ + mailbox = (MB_MCB *) mailbox_ptr; + +#ifdef NU_ENABLE_STACK_CHECK + + /* Call stack checking function to check for an overflow condition. */ + TCT_Check_Stack(); + +#endif + +#ifdef NU_ENABLE_HISTORY + + /* Make an entry that corresponds to this function in the system history + log. */ + HIC_Make_History_Entry(NU_DELETE_MAILBOX_ID, (UNSIGNED) mailbox, + (UNSIGNED) 0, (UNSIGNED) 0); + +#endif + + /* Call protection just in case another thread is using the mailbox. */ + TCT_System_Protect(); + +#ifdef INCLUDE_PROVIEW + _RTProf_DumpMailBox(RT_PROF_DELETE_MAILBOX,mailbox,RT_PROF_OK); +#endif /* INCLUDE_PROVIEW */ + /* Clear the mailbox ID. */ + mailbox -> mb_id = 0; + + /* Clear protection. */ + TCT_Unprotect(); + + /* Protect against access to the list of created mailboxes. */ + TCT_Protect(&MBD_List_Protect); + + /* Remove the mailbox from the list of created mailboxes. */ + CSC_Remove_From_List(&MBD_Created_Mailboxes_List, + &(mailbox -> mb_created)); + + /* Decrement the total number of created mailboxes. */ + MBD_Total_Mailboxes--; + + /* Pickup the suspended task pointer list. */ + suspend_ptr = mailbox -> mb_suspension_list; + + /* Walk the chain task(s) currently suspended on the mailbox. */ + preempt = 0; + while (suspend_ptr) + { + + /* Protect against system access. */ + TCT_System_Protect(); + + /* Resume the suspended task. Insure that the status returned is + NU_MAILBOX_DELETED. */ + suspend_ptr -> mb_return_status = NU_MAILBOX_DELETED; + + /* Point to the next suspend structure in the link. */ + next_ptr = (MB_SUSPEND *) (suspend_ptr -> mb_suspend_link.cs_next); + + /* Resume the specified task. */ + preempt = preempt | + TCC_Resume_Task((NU_TASK *) suspend_ptr -> mb_suspended_task, + NU_MAILBOX_SUSPEND); + + /* Determine if the next is the same as the head pointer. */ + if (next_ptr == mailbox -> mb_suspension_list) + + /* Clear the suspension pointer to signal the end of the list + traversal. */ + suspend_ptr = NU_NULL; + else + + /* Position the suspend pointer to the next suspend block. */ + suspend_ptr = next_ptr; + + /* Setup current protection pointer. */ + TCT_Set_Current_Protect(&MBD_List_Protect); + + /* Unprotect the system protection. */ + TCT_System_Unprotect(); + } + + /* Determine if preemption needs to occur. */ + if (preempt) + + /* Transfer control to system to facilitate preemption. */ + TCT_Control_To_System(); + + /* Release protection against access to the list of created mailboxes. */ + TCT_Unprotect(); + + /* Return to user mode */ + NU_USER_MODE(); + + /* Return a successful completion. */ + return(NU_SUCCESS); +} + + +/*************************************************************************/ +/* */ +/* FUNCTION */ +/* */ +/* MBC_Send_To_Mailbox */ +/* */ +/* DESCRIPTION */ +/* */ +/* This function sends a 4-word message to the specified mailbox. */ +/* If there are one or more tasks suspended on the mailbox for a */ +/* message, the message is copied into the message area of the */ +/* first task waiting and that task is resumed. If the mailbox */ +/* is full, suspension of the calling task is possible. */ +/* */ +/* CALLED BY */ +/* */ +/* Application */ +/* MBCE_Send_To_Mailbox Error checking shell */ +/* */ +/* CALLS */ +/* */ +/* CSC_Place_On_List Place on suspend list */ +/* CSC_Priority_Place_On_List Place on priority list */ +/* CSC_Remove_From_List Remove from suspend list */ +/* [HIC_Make_History_Entry] Make entry in history log */ +/* TCC_Resume_Task Resume a suspended task */ +/* TCC_Suspend_Task Suspend calling task */ +/* TCC_Task_Priority Pickup task's priority */ +/* [TCT_Check_Stack] Stack checking function */ +/* TCT_Control_To_System Transfer control to system */ +/* TCT_Current_Thread Pickup current thread pointer*/ +/* TCT_System_Protect Protect against system access*/ +/* TCT_Unprotect Release protection */ +/* */ +/* INPUTS */ +/* */ +/* mailbox_ptr Mailbox control block pointer*/ +/* message Pointer to message to send */ +/* suspend Suspension option if full */ +/* */ +/* OUTPUTS */ +/* */ +/* NU_SUCCESS If service is successful */ +/* NU_MAILBOX_FULL If mailbox is currently full */ +/* NU_TIMEOUT If timeout on service expires*/ +/* NU_MAILBOX_DELETED If mailbox is deleted during */ +/* suspension */ +/* NU_MAILBOX_RESET If mailbox is deleted during */ +/* suspension */ +/* */ +/* HISTORY */ +/* */ +/* DATE REMARKS */ +/* */ +/* 03-01-1993 Created initial version 1.0 */ +/* 04-19-1993 Verified version 1.0 */ +/* 03-01-1994 Changed function interface to */ +/* match the prototype, added */ +/* register variable logic, */ +/* optimized protection logic, */ +/* resulting in version 1.1 */ +/* */ +/* 03-18-1994 Verified version 1.1 */ +/* */ +/*************************************************************************/ +STATUS MBC_Send_To_Mailbox(NU_MAILBOX *mailbox_ptr, VOID *message, + UNSIGNED suspend) +{ + +R1 MB_MCB *mailbox; /* Mailbox control block ptr */ +MB_SUSPEND suspend_block; /* Allocate suspension block */ +R2 MB_SUSPEND *suspend_ptr; /* Pointer to suspend block */ +R3 UNSIGNED *source_ptr; /* Pointer to source */ +R4 UNSIGNED *destination_ptr; /* Pointer to destination */ +TC_TCB *task; /* Task pointer */ +STATUS preempt; /* Preempt flag */ +STATUS status; /* Completion status */ +NU_SUPERV_USER_VARIABLES + + /* Switch to supervisor mode */ + NU_SUPERVISOR_MODE(); + + /* Move input mailbox pointer into internal pointer. */ + mailbox = (MB_MCB *) mailbox_ptr; + + +#ifdef NU_ENABLE_STACK_CHECK + + /* Call stack checking function to check for an overflow condition. */ + TCT_Check_Stack(); + +#endif + +#ifdef NU_ENABLE_HISTORY + + /* Make an entry that corresponds to this function in the system history + log. */ + HIC_Make_History_Entry(NU_SEND_TO_MAILBOX_ID, (UNSIGNED) mailbox, + (UNSIGNED) message, (UNSIGNED) suspend); + +#endif + + /* Initialize the status as successful. */ + status = NU_SUCCESS; + + /* Protect against simultaneous access to the mailbox. */ + TCT_System_Protect(); + + /* Determine if the mailbox is empty or full. */ + if (mailbox -> mb_message_present) + { + + /* Mailbox already has a message. Determine if suspension is + required. */ + if (suspend) + { + + /* Suspension is requested. */ + + /* Increment the number of tasks waiting. */ + mailbox -> mb_tasks_waiting++; + +#ifdef INCLUDE_PROVIEW + _RTProf_DumpMailBox(RT_PROF_SEND_TO_MAILBOX,mailbox,RT_PROF_WAIT); +#endif /* INCLUDE_PROVIEW */ + + /* Setup the suspend block and suspend the calling task. */ + suspend_ptr = &suspend_block; + suspend_ptr -> mb_mailbox = mailbox; + suspend_ptr -> mb_suspend_link.cs_next = NU_NULL; + suspend_ptr -> mb_suspend_link.cs_previous = NU_NULL; + suspend_ptr -> mb_message_area = (UNSIGNED *) message; + task = (TC_TCB *) TCT_Current_Thread(); + suspend_ptr -> mb_suspended_task = task; + + /* Determine if priority or FIFO suspension is associated with the + mailbox. */ + if (mailbox -> mb_fifo_suspend) + { + + /* FIFO suspension is required. Link the suspend block into + the list of suspended tasks on this mailbox. */ + CSC_Place_On_List((CS_NODE **) &(mailbox ->mb_suspension_list), + &(suspend_ptr -> mb_suspend_link)); + } + else + { + + /* Get the priority of the current thread so the suspend block + can be placed in the appropriate place. */ + suspend_ptr -> mb_suspend_link.cs_priority = + TCC_Task_Priority(task); + + CSC_Priority_Place_On_List((CS_NODE **) + &(mailbox -> mb_suspension_list), + &(suspend_ptr -> mb_suspend_link)); + } + + /* Finally, suspend the calling task. Note that the suspension call + automatically clears the protection on the mailbox. */ + TCC_Suspend_Task((NU_TASK *) task, NU_MAILBOX_SUSPEND, + MBC_Cleanup, suspend_ptr, suspend); + + /* Pickup the return status. */ + status = suspend_ptr -> mb_return_status; + } + else + { + + /* Return a status of NU_MAILBOX_FULL because there is no + room in the mailbox for the message. */ + status = NU_MAILBOX_FULL; +#ifdef INCLUDE_PROVIEW + _RTProf_DumpMailBox(RT_PROF_SEND_TO_MAILBOX,mailbox,RT_PROF_FAIL); +#endif /* INCLUDE_PROVIEW */ + + } + } + else + { + + /* Determine if a task is waiting on the mailbox. */ + if (mailbox -> mb_suspension_list) + { + + /* Task is waiting on mailbox for a message. */ + + /* Decrement the number of tasks waiting on mailbox. */ + mailbox -> mb_tasks_waiting--; + +#ifdef INCLUDE_PROVIEW + _RTProf_DumpMailBox(RT_PROF_SEND_TO_MAILBOX,mailbox,RT_PROF_OK); +#endif /* INCLUDE_PROVIEW */ + + /* Remove the first suspended block from the list. */ + suspend_ptr = mailbox -> mb_suspension_list; + CSC_Remove_From_List((CS_NODE **) + &(mailbox -> mb_suspension_list), + &(suspend_ptr -> mb_suspend_link)); + + /* Setup the source and destination pointers. */ + source_ptr = (UNSIGNED *) message; + destination_ptr = suspend_ptr -> mb_message_area; + + /* Copy the message directly into the waiting task's + destination. */ + *destination_ptr = *source_ptr; + *(destination_ptr + 1) = *(source_ptr + 1); + *(destination_ptr + 2) = *(source_ptr + 2); + *(destination_ptr + 3) = *(source_ptr + 3); + + /* Setup the appropriate return value. */ + suspend_ptr -> mb_return_status = NU_SUCCESS; + + /* Wakeup the waiting task and check for preemption. */ + preempt = + TCC_Resume_Task((NU_TASK *) suspend_ptr -> mb_suspended_task, + NU_MAILBOX_SUSPEND); + + /* Determine if preemption needs to take place. */ + if (preempt) + + /* Transfer control to the system if the resumed task function + detects a preemption condition. */ + TCT_Control_To_System(); + } + else + { + + /* Mailbox is empty and no task is waiting. */ + + /* Setup the source and destination pointers. */ + source_ptr = (UNSIGNED *) message; + destination_ptr = &(mailbox -> mb_message_area[0]); + + /* Place the message in the mailbox. */ + *destination_ptr = *source_ptr; + *(destination_ptr + 1) = *(source_ptr + 1); + *(destination_ptr + 2) = *(source_ptr + 2); + *(destination_ptr + 3) = *(source_ptr + 3); + + /* Indicate that the mailbox has a message. */ + mailbox -> mb_message_present = NU_TRUE; + +#ifdef INCLUDE_PROVIEW + _RTProf_DumpMailBox(RT_PROF_SEND_TO_MAILBOX,mailbox,RT_PROF_OK); +#endif /* INCLUDE_PROVIEW */ + } + } + + /* Release protection. */ + TCT_Unprotect(); + + /* Return to user mode */ + NU_USER_MODE(); + + /* Return the completion status. */ + return(status); +} + + +/*************************************************************************/ +/* */ +/* FUNCTION */ +/* */ +/* MBC_Receive_From_Mailbox */ +/* */ +/* DESCRIPTION */ +/* */ +/* This function receives a message from the specified mailbox. */ +/* If there is a message currently in the mailbox, the message is */ +/* removed from the mailbox and placed in the caller's area. */ +/* Otherwise, if no message is present in the mailbox, suspension */ +/* of the calling task is possible. */ +/* */ +/* CALLED BY */ +/* */ +/* Application */ +/* MBCE_Receive_From_Mailbox Error checking shell */ +/* */ +/* CALLS */ +/* */ +/* CSC_Place_On_List Place on suspend list */ +/* CSC_Priority_Place_On_List Place on priority list */ +/* CSC_Remove_From_List Remove from suspend list */ +/* [HIC_Make_History_Entry] Make entry in history log */ +/* TCC_Resume_Task Resume a suspended task */ +/* TCC_Suspend_Task Suspend calling task */ +/* TCC_Task_Priority Pickup task priority */ +/* [TCT_Check_Stack] Stack checking function */ +/* TCT_Control_To_System Transfer control to system */ +/* TCT_Current_Thread Pickup current thread pointer*/ +/* TCT_System_Protect Protect mailbox */ +/* TCT_Unprotect Release protection */ +/* */ +/* INPUTS */ +/* */ +/* mailbox_ptr Mailbox control block pointer*/ +/* message Pointer to message to send */ +/* suspend Suspension option if empty */ +/* */ +/* OUTPUTS */ +/* */ +/* NU_SUCCESS If service is successful */ +/* NU_MAILBOX_EMPTY If mailbox is currently empty*/ +/* NU_TIMEOUT If timeout on service expires*/ +/* NU_MAILBOX_DELETED If mailbox is deleted during */ +/* suspension */ +/* NU_MAILBOX_RESET If mailbox is deleted during */ +/* suspension */ +/* */ +/* HISTORY */ +/* */ +/* DATE REMARKS */ +/* */ +/* 03-01-1993 Created initial version 1.0 */ +/* 04-19-1993 Verified version 1.0 */ +/* 03-01-1994 Changed function interface to */ +/* match the prototype, added */ +/* register variable logic, */ +/* optimized protection logic, */ +/* resulting in version 1.1 */ +/* */ +/* 03-18-1994 Verified version 1.1 */ +/* */ +/*************************************************************************/ +STATUS MBC_Receive_From_Mailbox(NU_MAILBOX *mailbox_ptr, VOID *message, + UNSIGNED suspend) +{ + +R1 MB_MCB *mailbox; /* Mailbox control block ptr */ +MB_SUSPEND suspend_block; /* Allocate suspension block */ +R2 MB_SUSPEND *suspend_ptr; /* Pointer to suspend block */ +R3 UNSIGNED *source_ptr; /* Pointer to source */ +R4 UNSIGNED *destination_ptr; /* Pointer to destination */ +TC_TCB *task; /* Task pointer */ +STATUS preempt; /* Preemption flag */ +STATUS status; /* Completion status */ +NU_SUPERV_USER_VARIABLES + + /* Switch to supervisor mode */ + NU_SUPERVISOR_MODE(); + + /* Move input mailbox pointer into internal pointer. */ + mailbox = (MB_MCB *) mailbox_ptr; + +#ifdef NU_ENABLE_STACK_CHECK + + /* Call stack checking function to check for an overflow condition. */ + TCT_Check_Stack(); + +#endif + +#ifdef NU_ENABLE_HISTORY + + /* Make an entry that corresponds to this function in the system history + log. */ + HIC_Make_History_Entry(NU_RECEIVE_FROM_MAILBOX_ID, (UNSIGNED) mailbox, + (UNSIGNED) message, (UNSIGNED) suspend); + +#endif + + /* Initialize the status as successful. */ + status = NU_SUCCESS; + + /* Protect against simultaneous access to the mailbox. */ + TCT_System_Protect(); + + /* Determine if the mailbox is empty or full. */ + if (mailbox -> mb_message_present) + { + + /* Copy message from mailbox into the caller's area. */ + + /* Setup the source and destination pointers. */ + source_ptr = &(mailbox -> mb_message_area[0]); + destination_ptr = (UNSIGNED *) message; + + /* Copy the message directly into the waiting task's + destination. */ + *destination_ptr = *source_ptr; + *(destination_ptr + 1) = *(source_ptr + 1); + *(destination_ptr + 2) = *(source_ptr + 2); + *(destination_ptr + 3) = *(source_ptr + 3); + + /* Determine if another task is waiting to place something into the + mailbox. */ + if (mailbox -> mb_suspension_list) + { + + /* Yes, another task is waiting to send something to the + mailbox. */ + + /* Decrement the number of tasks waiting counter. */ + mailbox -> mb_tasks_waiting--; + +#ifdef INCLUDE_PROVIEW + _RTProf_DumpMailBox(RT_PROF_RECEIVE_FROM_MAILBOX,mailbox,RT_PROF_OK); +#endif /* INCLUDE_PROVIEW */ + /* Remove the first suspended block from the list. */ + suspend_ptr = mailbox -> mb_suspension_list; + CSC_Remove_From_List((CS_NODE **) + &(mailbox -> mb_suspension_list), + &(suspend_ptr -> mb_suspend_link)); + + /* Setup the source and destination pointers. */ + source_ptr = suspend_ptr -> mb_message_area; + destination_ptr = &(mailbox -> mb_message_area[0]); + + /* Copy the message directly into the waiting task's + destination. */ + *destination_ptr = *source_ptr; + *(destination_ptr + 1) = *(source_ptr + 1); + *(destination_ptr + 2) = *(source_ptr + 2); + *(destination_ptr + 3) = *(source_ptr + 3); + + /* Setup the appropriate return value. */ + suspend_ptr -> mb_return_status = NU_SUCCESS; + + /* Resume the suspended task. */ + preempt = + TCC_Resume_Task((NU_TASK *) suspend_ptr -> mb_suspended_task, + NU_MAILBOX_SUSPEND); + + /* Determine if a preempt condition is present. */ + if (preempt) + + /* Transfer control to the system if the resumed task function + detects a preemption condition. */ + TCT_Control_To_System(); + } + else + { + + /* Clear the message present flag. */ + mailbox -> mb_message_present = NU_FALSE; + +#ifdef INCLUDE_PROVIEW + _RTProf_DumpMailBox(RT_PROF_RECEIVE_FROM_MAILBOX,mailbox,RT_PROF_OK); +#endif /* INCLUDE_PROVIEW */ + + } + + } + else + { + + /* Mailbox is empty. Determine if suspension is required. */ + if (suspend) + { + + /* Suspension is required. */ + + /* Increment the number of tasks waiting on the mailbox counter. */ + mailbox -> mb_tasks_waiting++; + +#ifdef INCLUDE_PROVIEW + _RTProf_DumpMailBox(RT_PROF_RECEIVE_FROM_MAILBOX,mailbox,RT_PROF_WAIT); +#endif /* INCLUDE_PROVIEW */ + + /* Setup the suspend block and suspend the calling task. */ + suspend_ptr = &suspend_block; + suspend_ptr -> mb_mailbox = mailbox; + suspend_ptr -> mb_suspend_link.cs_next = NU_NULL; + suspend_ptr -> mb_suspend_link.cs_previous = NU_NULL; + suspend_ptr -> mb_message_area = (UNSIGNED *) message; + task = (TC_TCB *) TCT_Current_Thread(); + suspend_ptr -> mb_suspended_task = task; + + /* Determine if priority or FIFO suspension is associated with the + mailbox. */ + if (mailbox -> mb_fifo_suspend) + { + + /* FIFO suspension is required. Link the suspend block into + the list of suspended tasks on this mailbox. */ + CSC_Place_On_List((CS_NODE **) &(mailbox ->mb_suspension_list), + &(suspend_ptr -> mb_suspend_link)); + } + else + { + + /* Get the priority of the current thread so the suspend block + can be placed in the appropriate place. */ + suspend_ptr -> mb_suspend_link.cs_priority = + TCC_Task_Priority(task); + + CSC_Priority_Place_On_List((CS_NODE **) + &(mailbox -> mb_suspension_list), + &(suspend_block.mb_suspend_link)); + } + + /* Finally, suspend the calling task. Note that the suspension call + automatically clears the protection on the mailbox. */ + TCC_Suspend_Task((NU_TASK *) task, NU_MAILBOX_SUSPEND, + MBC_Cleanup, &suspend_block, suspend); + + /* Pickup the return status. */ + status = suspend_ptr -> mb_return_status; + } + else + { + + /* Return a status of NU_MAILBOX_EMPTY because there is + nothing in the mailbox. */ + status = NU_MAILBOX_EMPTY; + +#ifdef INCLUDE_PROVIEW + _RTProf_DumpMailBox(RT_PROF_RECEIVE_FROM_MAILBOX,mailbox,RT_PROF_FAIL); +#endif /* INCLUDE_PROVIEW */ + } + + } + + /* Release protection. */ + TCT_Unprotect(); + + /* Return to user mode */ + NU_USER_MODE(); + + /* Return the completion status. */ + return(status); +} + + +/*************************************************************************/ +/* */ +/* FUNCTION */ +/* */ +/* MBC_Cleanup */ +/* */ +/* DESCRIPTION */ +/* */ +/* This function is responsible for removing a suspension block */ +/* from a mailbox. It is not called unless a timeout or a task */ +/* terminate is in progress. Note that protection is already in */ +/* effect - the same protection at suspension time. */ +/* */ +/* CALLED BY */ +/* */ +/* TCC_Timeout Task timeout */ +/* TCC_Terminate Task terminate */ +/* */ +/* CALLS */ +/* */ +/* CSC_Remove_From_List Remove suspend block from */ +/* the suspension list */ +/* */ +/* INPUTS */ +/* */ +/* information Pointer to suspend block */ +/* */ +/* OUTPUTS */ +/* */ +/* None */ +/* */ +/* HISTORY */ +/* */ +/* DATE REMARKS */ +/* */ +/* 03-01-1993 Created initial version 1.0 */ +/* 04-19-1993 Verified version 1.0 */ +/* */ +/*************************************************************************/ +VOID MBC_Cleanup(VOID *information) +{ + +MB_SUSPEND *suspend_ptr; /* Suspension block pointer */ +NU_SUPERV_USER_VARIABLES + + /* Switch to supervisor mode */ + NU_SUPERVISOR_MODE(); + + /* Use the information pointer as a suspend pointer. */ + suspend_ptr = (MB_SUSPEND *) information; + + /* By default, indicate that the service timed-out. It really does not + matter if this function is called from a terminate request since + the task does not resume. */ + suspend_ptr -> mb_return_status = NU_TIMEOUT; + + /* Decrement the number of tasks waiting counter. */ + (suspend_ptr -> mb_mailbox) -> mb_tasks_waiting--; + + /* Unlink the suspend block from the suspension list. */ + CSC_Remove_From_List((CS_NODE **) + &((suspend_ptr -> mb_mailbox) -> mb_suspension_list), + &(suspend_ptr -> mb_suspend_link)); + + /* Return to user mode */ + NU_USER_MODE(); +} + + + + + + +