📄 quc.c
字号:
NU_QUEUE_SUSPEND);
/* Determine if the next is the same as the head pointer. */
if (next_ptr == queue -> qu_suspension_list)
/* Clear the suspension pointer to signal the end of the list
traversal. */
suspend_ptr = NU_NULL;
else
/* Position suspend pointer to the next pointer. */
suspend_ptr = next_ptr;
/* Modify current protection. */
TCT_Set_Current_Protect(&QUD_List_Protect);
/* Clear the system protection. */
TCT_System_Unprotect();
}
/* Pickup the urgent message suspension list. */
suspend_ptr = queue -> qu_urgent_list;
/* Walk the chain task(s) currently suspended on the queue. */
while (suspend_ptr)
{
/* Protect against system access. */
TCT_System_Protect();
/* Resume the suspended task. Insure that the status returned is
NU_QUEUE_DELETED. */
suspend_ptr -> qu_return_status = NU_QUEUE_DELETED;
/* Point to the next suspend structure in the link. */
next_ptr = (QU_SUSPEND *) (suspend_ptr -> qu_suspend_link.cs_next);
/* Resume the specified task. */
preempt = preempt |
TCC_Resume_Task((NU_TASK *) suspend_ptr -> qu_suspended_task,
NU_QUEUE_SUSPEND);
/* Determine if the next is the same as the head pointer. */
if (next_ptr == queue -> qu_urgent_list)
/* Clear the suspension pointer to signal the end of the list
traversal. */
suspend_ptr = NU_NULL;
else
/* Position to the next suspend block in the list. */
suspend_ptr = next_ptr;
/* Modify current protection. */
TCT_Set_Current_Protect(&QUD_List_Protect);
/* Clear 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 queues. */
TCT_Unprotect();
/* Return to user mode */
NU_USER_MODE();
/* Return a successful completion. */
return(NU_SUCCESS);
}
/*************************************************************************/
/* */
/* FUNCTION */
/* */
/* QUC_Send_To_Queue */
/* */
/* DESCRIPTION */
/* */
/* This function sends a message to the specified queue. The */
/* message length is determined by the caller. If there are one */
/* or more tasks suspended on the queue for a message, the message */
/* is copied into the message area of the first waiting task. If */
/* the task's request is satisfied, it is resumed. Otherwise, if */
/* the queue cannot hold the message, suspension of the calling */
/* task is an option of the caller. */
/* */
/* CALLED BY */
/* */
/* Application */
/* QUCE_Send_To_Queue 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 queue */
/* TCT_Unprotect Release protection */
/* */
/* INPUTS */
/* */
/* queue_ptr Queue control block pointer */
/* message Pointer to message to send */
/* size Size of message to send */
/* suspend Suspension option if full */
/* */
/* OUTPUTS */
/* */
/* NU_SUCCESS If service is successful */
/* NU_QUEUE_FULL If queue is currently full */
/* NU_TIMEOUT If timeout on service expires*/
/* NU_QUEUE_DELETED If queue was deleted during */
/* suspension */
/* NU_QUEUE_RESET If queue was reset during */
/* suspension */
/* */
/*************************************************************************/
STATUS QUC_Send_To_Queue(NU_QUEUE *queue_ptr, VOID *message, UNSIGNED size,
UNSIGNED suspend)
{
R1 QU_QCB *queue; /* Queue control block ptr */
QU_SUSPEND suspend_block; /* Allocate suspension block */
QU_SUSPEND *suspend_ptr; /* Pointer to suspend block */
R3 UNSIGNED_PTR source; /* Pointer to source */
R4 UNSIGNED_PTR destination; /* Pointer to destination */
UNSIGNED copy_size; /* Partial copy size */
R2 INT i; /* Working counter */
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 queue pointer into internal pointer. */
queue = (QU_QCB *) queue_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_QUEUE_ID, (UNSIGNED) queue,
(UNSIGNED) message, (UNSIGNED) size);
#endif
/* Initialize the status as successful. */
status = NU_SUCCESS;
/* Protect against simultaneous access to the queue. */
TCT_System_Protect();
/* Determine if an extra word of overhead needs to be added to the
calculation. */
if (queue -> qu_fixed_size)
/* No overhead. */
i = 0;
else
{
/* Variable messages have one additional word of overhead. */
i = 1;
/* Make special check to see if a suspension needs to be
forced for a variable length message. */
if ((queue -> qu_suspension_list) && (queue -> qu_messages))
{
/* Pickup task control block pointer. */
task = (TC_TCB *) TCT_Current_Thread();
/* Now we know that there are other task(s) are suspended trying
to send a variable length message. Determine whether or not
a suspension should be forced. */
if ((queue -> qu_fifo_suspend) ||
(suspend == NU_NO_SUSPEND) ||
((queue -> qu_suspension_list) -> qu_suspend_link.cs_priority <=
TCC_Task_Priority(task)))
/* Bump the computed size to avoid placing the new variable
length message ahead of the suspended tasks. */
i = (INT) queue -> qu_available;
}
}
/* Determine if there is enough room in the queue for the message. The
extra logic is to prevent a variable-length message from sn*/
if (queue -> qu_available < (size + i))
{
/* Queue does not have room for the message. Determine if
suspension is required. */
if (suspend)
{
/* Suspension is requested. */
/* Increment the number of tasks waiting. */
queue -> qu_tasks_waiting++;
#ifdef NU_PROFILE_PLUS
PRF_PLUS_QUC_SEND_TO_QUEUE_0
#endif /* NU_PROFILE_PLUS */
/* Setup the suspend block and suspend the calling task. */
suspend_ptr = &suspend_block;
suspend_ptr -> qu_queue = queue;
suspend_ptr -> qu_suspend_link.cs_next = NU_NULL;
suspend_ptr -> qu_suspend_link.cs_previous = NU_NULL;
suspend_ptr -> qu_message_area = (UNSIGNED_PTR) message;
suspend_ptr -> qu_message_size = size;
task = (TC_TCB *) TCT_Current_Thread();
suspend_ptr -> qu_suspended_task = task;
/* Determine if priority or FIFO suspension is associated with the
queue. */
if (queue -> qu_fifo_suspend)
{
/* FIFO suspension is required. Link the suspend block into
the list of suspended tasks on this queue. */
CSC_Place_On_List((CS_NODE **) &(queue -> qu_suspension_list),
&(suspend_ptr -> qu_suspend_link));
}
else
{
/* Get the priority of the current thread so the suspend block
can be placed in the appropriate place. */
suspend_ptr -> qu_suspend_link.cs_priority =
TCC_Task_Priority(task);
CSC_Priority_Place_On_List((CS_NODE **)
&(queue -> qu_suspension_list),
&(suspend_ptr -> qu_suspend_link));
}
/* Finally, suspend the calling task. Note that the suspension call
automatically clears the protection on the queue. */
TCC_Suspend_Task((NU_TASK *) task, NU_QUEUE_SUSPEND,
QUC_Cleanup, suspend_ptr, suspend);
/* Pickup the return status. */
status = suspend_ptr -> qu_return_status;
}
else
{
/* Return a status of NU_QUEUE_FULL because there is no
room in the queue for the message. */
status = NU_QUEUE_FULL;
#ifdef NU_PROFILE_PLUS
PRF_PLUS_QUC_SEND_TO_QUEUE_1
#endif /* NU_PROFILE_PLUS */
}
}
else
{
/* Determine if a task is waiting on an empty queue. */
if ((queue -> qu_suspension_list) && (queue -> qu_messages == 0))
{
/* Task is waiting on an empty queue for a message. */
/* Decrement the number of tasks waiting on queue. */
queue -> qu_tasks_waiting--;
#ifdef NU_PROFILE_PLUS
PRF_PLUS_QUC_SEND_TO_QUEUE_2
#endif /* NU_PROFILE_PLUS */
/* Remove the first suspended block from the list. */
suspend_ptr = queue -> qu_suspension_list;
CSC_Remove_From_List((CS_NODE **) &(queue -> qu_suspension_list),
&(suspend_ptr -> qu_suspend_link));
/* Setup the source and destination pointers. */
source = (UNSIGNED_PTR) message;
destination = suspend_ptr -> qu_message_area;
/* Initialize the return status. */
suspend_ptr -> qu_return_status = NU_SUCCESS;
/* Loop to actually copy the message. */
i = (INT) size;
do
{
*(destination++) = *(source);
if ((--i) == 0)
break;
source++;
} while (1);
/* Return the size of the message copied. */
suspend_ptr -> qu_actual_size = size;
/* Wakeup the waiting task and check for preemption. */
preempt =
TCC_Resume_Task((NU_TASK *) suspend_ptr -> qu_suspended_task,
NU_QUEUE_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
{
/* There is enough room in the queue and no task is waiting. */
/* Setup the source pointer. */
source = (UNSIGNED_PTR) message;
destination = queue -> qu_write;
/* Process according to the type of message supported. */
if (queue -> qu_fixed_size)
{
⌨️ 快捷键说明
复制代码
Ctrl + C
搜索代码
Ctrl + F
全屏模式
F11
切换主题
Ctrl + Shift + D
显示快捷键
?
增大字号
Ctrl + =
减小字号
Ctrl + -