freecalypso-sw: gsm-fw/nucleus/pis.c annotate

annotate gsm-fw/nucleus/pis.c @ 671:210268d8e553

gsm-fw: comlib included in the build along with ccd CONFIG_INCLUDE_CCD eliminated and absorbed into CONFIG_INCLUDE_PS

author	Michael Spacefalcon <msokolov@ivan.Harhan.ORG>
date	Sun, 28 Sep 2014 18:23:19 +0000
parents	afceeeb2cba1
children

rev	line source
79 947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1 /*************************************************************************/
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2 /* */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	3 /* Copyright Mentor Graphics Corporation 2002 */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	4 /* All Rights Reserved. */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	5 /* */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	6 /* THIS WORK CONTAINS TRADE SECRET AND PROPRIETARY INFORMATION WHICH IS */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	7 /* THE PROPERTY OF MENTOR GRAPHICS CORPORATION OR ITS LICENSORS AND IS */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	8 /* SUBJECT TO LICENSE TERMS. */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	9 /* */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	10 /*************************************************************************/
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	11
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	12 /*************************************************************************/
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	13 /* */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	14 /* FILE NAME VERSION */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	15 /* */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	16 /* pis.c Nucleus PLUS 1.14 */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	17 /* */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	18 /* COMPONENT */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	19 /* */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	20 /* PI - Pipe Management */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	21 /* */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	22 /* DESCRIPTION */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	23 /* */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	24 /* This file contains the supplemental routines for the pipe */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	25 /* management component. */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	26 /* */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	27 /* DATA STRUCTURES */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	28 /* */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	29 /* None */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	30 /* */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	31 /* FUNCTIONS */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	32 /* */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	33 /* PIS_Reset_Pipe Reset a pipe */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	34 /* PIS_Send_To_Front_Of_Pipe Send message to pipe's front */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	35 /* PIS_Broadcast_To_Pipe Broadcast a message to pipe */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	36 /* */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	37 /* DEPENDENCIES */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	38 /* */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	39 /* cs_extr.h Common Service functions */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	40 /* tc_extr.h Thread Control functions */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	41 /* pi_extr.h Pipe functions */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	42 /* hi_extr.h History functions */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	43 /* */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	44 /* HISTORY */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	45 /* */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	46 /* DATE REMARKS */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	47 /* */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	48 /* 03-01-1994 Created initial version 1.1 from */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	49 /* routines originally in core */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	50 /* */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	51 /* 03-18-1994 Verified version 1.1 */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	52 /* 04-17-1996 updated to version 1.2 */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	53 /* 02-04-1998 Corrected SPR434 resulting in */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	54 /* version 1.2a. */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	55 /* 03-24-1998 Released version 1.3 */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	56 /* 03-26-1999 Released 1.11m (new release */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	57 /* numbering scheme) */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	58 /* 04-17-2002 Released version 1.13m */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	59 /* 11-07-2002 Released version 1.14 */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	60 /*************************************************************************/
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	61 #define NU_SOURCE_FILE
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	62
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	63
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	64 #include "cs_extr.h" /* Common service functions */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	65 #include "tc_extr.h" /* Thread control functions */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	66 #include "pi_extr.h" /* Pipe functions */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	67 #include "hi_extr.h" /* History functions */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	68 #include "profiler.h" /* ProView interface */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	69
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	70
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	71 /* Define external inner-component global data references. */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	72
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	73 extern CS_NODE *PID_Created_Pipes_List;
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	74 extern UNSIGNED PID_Total_Pipes;
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	75 extern TC_PROTECT PID_List_Protect;
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	76
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	77
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	78 /* Define internal component function prototypes. */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	79
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	80 VOID PIC_Cleanup(VOID *information);
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	81
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	82
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	83 /*************************************************************************/
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	84 /* */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	85 /* FUNCTION */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	86 /* */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	87 /* PIS_Reset_Pipe */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	88 /* */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	89 /* DESCRIPTION */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	90 /* */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	91 /* This function resets the specified pipe back to the original */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	92 /* state. Any messages in the pipe are discarded. Also, any */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	93 /* tasks currently suspended on the pipe are resumed with the */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	94 /* reset status. */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	95 /* */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	96 /* CALLED BY */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	97 /* */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	98 /* Application */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	99 /* PISE_Reset_Pipe Error checking shell */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	100 /* */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	101 /* CALLS */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	102 /* */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	103 /* [HIC_Make_History_Entry] Make entry in history log */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	104 /* TCC_Resume_Task Resume a suspended task */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	105 /* [TCT_Check_Stack] Stack checking function */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	106 /* TCT_Control_To_System Transfer control to system */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	107 /* TCT_System_Protect Protect against system access*/
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	108 /* TCT_Unprotect Release protection */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	109 /* */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	110 /* INPUTS */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	111 /* */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	112 /* pipe_ptr Pipe control block pointer */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	113 /* */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	114 /* OUTPUTS */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	115 /* */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	116 /* NU_SUCCESS */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	117 /* */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	118 /* HISTORY */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	119 /* */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	120 /* NAME DATE REMARKS */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	121 /* */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	122 /* 03-01-1993 Created initial version 1.0 */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	123 /* 04-19-1993 Verified version 1.0 */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	124 /* 03-01-1994 Changed function interfaces to */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	125 /* match those in prototype, */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	126 /* added register options, changed */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	127 /* protection logic to reduce */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	128 /* overhead, fixed read and write */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	129 /* pointers to both point at the */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	130 /* start, resulting in version 1.1 */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	131 /* */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	132 /* 03-18-1994 Verified version 1.1 */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	133 /* 02-04-1998 Corrected SPR434. */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	134 /* */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	135 /*************************************************************************/
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	136 STATUS PIS_Reset_Pipe(NU_PIPE *pipe_ptr)
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	137 {
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	138
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	139 R1 PI_PCB pipe; / Pipe control block ptr */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	140 PI_SUSPEND suspend_ptr; / Suspend block pointer */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	141 PI_SUSPEND next_ptr; / Next suspend block pointer*/
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	142 STATUS preempt; /* Status for resume call */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	143 NU_SUPERV_USER_VARIABLES
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	144
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	145 /* Switch to supervisor mode */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	146 NU_SUPERVISOR_MODE();
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	147
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	148 /* Move input pipe pointer into internal pointer. */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	149 pipe = (PI_PCB *) pipe_ptr;
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	150
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	151
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	152 #ifdef NU_ENABLE_STACK_CHECK
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	153
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	154 /* Call stack checking function to check for an overflow condition. */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	155 TCT_Check_Stack();
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	156
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	157 #endif
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	158
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	159 #ifdef NU_ENABLE_HISTORY
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	160
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	161 /* Make an entry that corresponds to this function in the system history
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	162 log. */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	163 HIC_Make_History_Entry(NU_RESET_PIPE_ID, (UNSIGNED) pipe,
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	164 (UNSIGNED) 0, (UNSIGNED) 0);
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	165
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	166 #endif
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	167
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	168 /* Protect against access to the pipe. */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	169 TCT_System_Protect();
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	170
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	171 /* Pickup the suspended task suspension list. */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	172 suspend_ptr = pipe -> pi_suspension_list;
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	173
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	174 /* Walk the chain task(s) currently suspended on the pipe. */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	175 preempt = 0;
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	176 while (suspend_ptr)
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	177 {
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	178
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	179 /* Resume the suspended task. Insure that the status returned is
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	180 NU_PIPE_RESET. */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	181 suspend_ptr -> pi_return_status = NU_PIPE_RESET;
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	182
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	183 /* Point to the next suspend structure in the link. */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	184 next_ptr = (PI_SUSPEND *) (suspend_ptr -> pi_suspend_link.cs_next);
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	185
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	186 /* Resume the specified task. */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	187 preempt = preempt \|
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	188 TCC_Resume_Task((NU_TASK *) suspend_ptr -> pi_suspended_task,
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	189 NU_PIPE_SUSPEND);
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	190
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	191 /* Determine if the next is the same as the head pointer. */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	192 if (next_ptr == pipe -> pi_suspension_list)
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	193
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	194 /* Clear the suspension pointer to signal the end of the list
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	195 traversal. */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	196 suspend_ptr = NU_NULL;
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	197 else
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	198
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	199 /* Position the suspend pointer to the next block. */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	200 suspend_ptr = next_ptr;
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	201 }
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	202
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	203 /* Pickup the urgent message suspension list. */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	204 suspend_ptr = pipe -> pi_urgent_list;
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	205
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	206 /* Walk the chain task(s) currently suspended on the pipe. */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	207 while (suspend_ptr)
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	208 {
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	209
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	210 /* Resume the suspended task. Insure that the status returned is
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	211 NU_PIPE_RESET. */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	212 suspend_ptr -> pi_return_status = NU_PIPE_RESET;
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	213
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	214 /* Point to the next suspend structure in the link. */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	215 next_ptr = (PI_SUSPEND *) (suspend_ptr -> pi_suspend_link.cs_next);
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	216
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	217 /* Resume the specified task. */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	218 preempt = preempt \|
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	219 TCC_Resume_Task((NU_TASK *) suspend_ptr -> pi_suspended_task,
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	220 NU_PIPE_SUSPEND);
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	221
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	222 /* Determine if the next is the same as the head pointer. */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	223 if (next_ptr == pipe -> pi_urgent_list)
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	224
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	225 /* Clear the suspension pointer to signal the end of the list
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	226 traversal. */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	227 suspend_ptr = NU_NULL;
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	228 else
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	229
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	230 /* Position the suspend pointer to the next active block. */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	231 suspend_ptr = next_ptr;
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	232 }
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	233
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	234 /* Initialize various elements of the pipe. */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	235 pipe -> pi_available = pipe -> pi_end - pipe -> pi_start;
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	236 pipe -> pi_messages = 0;
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	237 pipe -> pi_read = pipe -> pi_start;
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	238 pipe -> pi_write = pipe -> pi_start;
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	239 pipe -> pi_tasks_waiting = 0;
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	240 pipe -> pi_suspension_list = NU_NULL;
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	241 pipe -> pi_urgent_list = NU_NULL;
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	242
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	243 #ifdef INCLUDE_PROVIEW
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	244 _RTProf_DumpPipe(RT_PROF_RESET_PIPE,pipe,RT_PROF_OK);
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	245 #endif /* INCLUDE_PROVIEW */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	246
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	247 /* Determine if preemption needs to occur. */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	248 if (preempt)
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	249
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	250 /* Transfer control to system to facilitate preemption. */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	251 TCT_Control_To_System();
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	252
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	253 /* Release protection against access to the pipe. */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	254 TCT_Unprotect();
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	255
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	256 /* Return to user mode */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	257 NU_USER_MODE();
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	258
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	259 /* Return a successful completion. */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	260 return(NU_SUCCESS);
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	261 }
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	262
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	263
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	264 /*************************************************************************/
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	265 /* */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	266 /* FUNCTION */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	267 /* */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	268 /* PIS_Send_To_Front_Of_Pipe */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	269 /* */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	270 /* DESCRIPTION */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	271 /* */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	272 /* This function sends a message to the front of the specified */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	273 /* message pipe. The message length is determined by the caller. */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	274 /* If there are any tasks suspended on the pipe for a message, the */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	275 /* message is copied into the message area of the first waiting */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	276 /* task and that task is resumed. If there is enough room in the */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	277 /* pipe, the message is copied in front of all other messages. */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	278 /* If there is not enough room in the pipe, suspension of the */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	279 /* caller is possible. */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	280 /* */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	281 /* CALLED BY */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	282 /* */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	283 /* Application */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	284 /* PISE_Send_To_Front_Of_Pipe Error checking shell */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	285 /* */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	286 /* CALLS */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	287 /* */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	288 /* CSC_Place_On_List Place on suspend list */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	289 /* CSC_Remove_From_List Remove from suspend list */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	290 /* [HIC_Make_History_Entry] Make entry in history log */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	291 /* TCC_Resume_Task Resume a suspended task */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	292 /* TCC_Suspend_Task Suspend calling task */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	293 /* [TCT_Check_Stack] Stack checking function */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	294 /* TCT_Control_To_System Transfer control to system */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	295 /* TCT_Current_Thread Pickup current thread pointer*/
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	296 /* TCT_System_Protect Protect pipe */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	297 /* TCT_Unprotect Release protection */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	298 /* */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	299 /* INPUTS */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	300 /* */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	301 /* pipe_ptr Pipe control block pointer */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	302 /* message Pointer to message to send */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	303 /* size Size of message to send */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	304 /* suspend Suspension option if full */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	305 /* */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	306 /* OUTPUTS */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	307 /* */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	308 /* NU_SUCCESS If service is successful */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	309 /* NU_PIPE_FULL If pipe is currently full */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	310 /* NU_TIMEOUT If timeout on service expires*/
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	311 /* NU_PIPE_DELETED If pipe was deleted during */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	312 /* suspension */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	313 /* NU_PIPE_RESET If pipe was reset during */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	314 /* suspension */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	315 /* */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	316 /* HISTORY */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	317 /* */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	318 /* DATE REMARKS */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	319 /* */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	320 /* 03-01-1993 Created initial version 1.0 */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	321 /* 04-19-1993 Verified version 1.0 */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	322 /* 03-01-1994 Changed function interfaces to */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	323 /* match those in prototype, */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	324 /* added register options, changed */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	325 /* protection logic to reduce */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	326 /* overhead, optimized copy loop, */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	327 /* resulting in version 1.1 */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	328 /* */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	329 /* 03-18-1994 Verified version 1.1 */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	330 /* */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	331 /*************************************************************************/
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	332 STATUS PIS_Send_To_Front_Of_Pipe(NU_PIPE pipe_ptr, VOID message,
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	333 UNSIGNED size, UNSIGNED suspend)
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	334 {
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	335
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	336 R1 PI_PCB pipe; / Pipe control block ptr */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	337 PI_SUSPEND suspend_block; /* Allocate suspension block */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	338 PI_SUSPEND suspend_ptr; / Pointer to suspend block */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	339 R2 BYTE_PTR source; /* Pointer to source */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	340 R3 BYTE_PTR destination; /* Pointer to destination */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	341 UNSIGNED copy_size; /* Partial copy size */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	342 R4 INT i; /* Working counter */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	343 UNSIGNED pad = 0; /* Number of pad bytes */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	344 TC_TCB task; / Task pointer */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	345 STATUS preempt; /* Preempt flag */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	346 STATUS status; /* Completion status */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	347 NU_SUPERV_USER_VARIABLES
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	348
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	349 /* Switch to supervisor mode */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	350 NU_SUPERVISOR_MODE();
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	351
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	352 /* Move input pipe pointer into internal pointer. */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	353 pipe = (PI_PCB *) pipe_ptr;
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	354
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	355
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	356 #ifdef NU_ENABLE_STACK_CHECK
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	357
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	358 /* Call stack checking function to check for an overflow condition. */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	359 TCT_Check_Stack();
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	360
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	361 #endif
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	362
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	363 #ifdef NU_ENABLE_HISTORY
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	364
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	365 /* Make an entry that corresponds to this function in the system history
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	366 log. */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	367 HIC_Make_History_Entry(NU_SEND_TO_FRONT_OF_PIPE_ID, (UNSIGNED) pipe,
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	368 (UNSIGNED) message, (UNSIGNED) size);
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	369
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	370 #endif
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	371
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	372 /* Initialize the status as successful. */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	373 status = NU_SUCCESS;
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	374
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	375 /* Protect against simultaneous access to the pipe. */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	376 TCT_System_Protect();
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	377
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	378 /* Determine if an extra word of overhead needs to be added to the
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	379 calculation. */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	380 if (pipe -> pi_fixed_size)
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	381
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	382 /* No overhead. */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	383 i = 0;
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	384 else
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	385 {
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	386
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	387 /* Variable messages have one additional word of overhead. */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	388 i = sizeof(UNSIGNED);
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	389
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	390 /* Calculate the number of pad bytes necessary to keep the pipe
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	391 write pointer on an UNSIGNED data element alignment. */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	392 pad = (((size + sizeof(UNSIGNED) - 1)/sizeof(UNSIGNED)) *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	393 sizeof(UNSIGNED)) - size;
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	394
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	395 /* Insure that padding is included in the overhead. */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	396 i = i + ((INT) pad);
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	397
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	398 /* Make special check to see if a suspension needs to be
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	399 forced for a variable length message. */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	400 if ((pipe -> pi_suspension_list) && (pipe -> pi_messages))
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	401 {
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	402
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	403 /* Pickup task control block pointer. */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	404 task = (TC_TCB *) TCT_Current_Thread();
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	405
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	406 /* Now we know that there are other task(s) are suspended trying
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	407 to send a variable length message. Determine whether or not
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	408 a suspension should be forced. */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	409 if ((pipe -> pi_fifo_suspend) \|\|
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	410 (suspend == NU_NO_SUSPEND) \|\|
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	411 ((pipe -> pi_suspension_list) -> pi_suspend_link.cs_priority <=
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	412 TCC_Task_Priority(task)))
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	413
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	414 /* Bump the computed size to avoid placing the new variable
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	415 length message ahead of the suspended tasks. */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	416 i = (INT) pipe -> pi_available;
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	417 }
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	418 }
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	419
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	420 /* Determine if there is enough room in the pipe for the message. */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	421 if (pipe -> pi_available < (size + i))
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	422 {
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	423
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	424 /* pipe does not have room for the message. Determine if
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	425 suspension is required. */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	426 if (suspend)
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	427 {
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	428
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	429 /* Suspension is requested. */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	430
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	431 /* Increment the number of tasks waiting. */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	432 pipe -> pi_tasks_waiting++;
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	433
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	434 #ifdef INCLUDE_PROVIEW
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	435 _RTProf_DumpPipe(RT_PROF_SEND_TO_FRONT_OF_PIPE,pipe,RT_PROF_WAIT);
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	436 #endif /* INCLUDE_PROVIEW */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	437
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	438 /* Setup the suspend block and suspend the calling task. */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	439 suspend_ptr = &suspend_block;
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	440 suspend_ptr -> pi_pipe = pipe;
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	441 suspend_ptr -> pi_suspend_link.cs_next = NU_NULL;
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	442 suspend_ptr -> pi_suspend_link.cs_previous = NU_NULL;
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	443 suspend_ptr -> pi_message_area = (BYTE_PTR) message;
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	444 suspend_ptr -> pi_message_size = size;
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	445 task = (TC_TCB *) TCT_Current_Thread();
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	446 suspend_ptr -> pi_suspended_task = task;
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	447
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	448 /* Place the task on the urgent message suspension list. */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	449 CSC_Place_On_List((CS_NODE **) &(pipe -> pi_urgent_list),
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	450 &(suspend_ptr -> pi_suspend_link));
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	451
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	452 /* Move the head pointer of the list to make this suspension the
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	453 first in the list. */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	454 pipe -> pi_urgent_list = (PI_SUSPEND *)
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	455 (pipe -> pi_urgent_list) -> pi_suspend_link.cs_previous;
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	456
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	457 /* Finally, suspend the calling task. Note that the suspension call
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	458 automatically clears the protection on the pipe. */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	459 TCC_Suspend_Task((NU_TASK *) task, NU_PIPE_SUSPEND,
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	460 PIC_Cleanup, suspend_ptr, suspend);
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	461
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	462 /* Pickup the return status. */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	463 status = suspend_ptr -> pi_return_status;
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	464 }
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	465 else
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	466 {
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	467
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	468 /* Return a status of NU_PIPE_FULL because there is no
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	469 room in the pipe for the message. */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	470 status = NU_PIPE_FULL;
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	471
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	472 #ifdef INCLUDE_PROVIEW
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	473 _RTProf_DumpPipe(RT_PROF_SEND_TO_FRONT_OF_PIPE,pipe,RT_PROF_FAIL);
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	474 #endif /* INCLUDE_PROVIEW */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	475
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	476 }
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	477 }
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	478 else
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	479 {
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	480
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	481 /* Determine if a task is waiting on an empty pipe. */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	482 if ((pipe -> pi_suspension_list) && (pipe -> pi_messages == 0))
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	483 {
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	484
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	485 /* Task is waiting on pipe for a message. */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	486
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	487 /* Decrement the number of tasks waiting on pipe. */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	488 pipe -> pi_tasks_waiting--;
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	489
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	490 #ifdef INCLUDE_PROVIEW
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	491 _RTProf_DumpPipe(RT_PROF_SEND_TO_FRONT_OF_PIPE,pipe,RT_PROF_OK);
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	492 #endif /* INCLUDE_PROVIEW */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	493
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	494 /* Remove the first suspended block from the list. */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	495 suspend_ptr = pipe -> pi_suspension_list;
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	496 CSC_Remove_From_List((CS_NODE **) &(pipe -> pi_suspension_list),
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	497 &(suspend_ptr -> pi_suspend_link));
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	498
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	499 /* Setup the source and destination pointers. */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	500 source = (BYTE_PTR) message;
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	501 destination = suspend_ptr -> pi_message_area;
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	502
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	503 /* Initialize the return status. */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	504 suspend_ptr -> pi_return_status = NU_SUCCESS;
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	505
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	506 /* Loop to actually copy the message. */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	507 i = (INT) size;
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	508 do
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	509 {
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	510 (destination++) = (source);
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	511 if ((--i) == 0)
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	512 break;
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	513 source++;
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	514 } while (1);
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	515
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	516 /* Return the size of the message copied. */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	517 suspend_ptr -> pi_actual_size = size;
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	518
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	519 /* Wakeup the waiting task and check for preemption. */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	520 preempt =
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	521 TCC_Resume_Task((NU_TASK *) suspend_ptr -> pi_suspended_task,
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	522 NU_PIPE_SUSPEND);
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	523
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	524 /* Determine if preemption needs to take place. */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	525 if (preempt)
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	526
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	527 /* Transfer control to the system if the resumed task function
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	528 detects a preemption condition. */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	529 TCT_Control_To_System();
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	530 }
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	531 else
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	532 {
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	533
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	534 /* There is enough room in the pipe and no task is waiting. */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	535
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	536 /* Setup the source pointer. */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	537 source = (BYTE_PTR) message;
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	538 destination = pipe -> pi_read;
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	539
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	540 /* Process according to the type of message supported. */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	541 if (pipe -> pi_fixed_size)
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	542 {
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	543
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	544 /* Fixed-size message pipe. */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	545
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	546 /* Determine if the read pointer is at the top of the pipe
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	547 area. */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	548 if (destination == pipe -> pi_start)
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	549
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	550 /* Prepare to place the message in the lower part of the
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	551 pipe area. */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	552 destination = pipe -> pi_end - size;
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	553 else
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	554
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	555 /* Backup the length of the message from the current
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	556 read pointer. */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	557 destination = destination - size;
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	558
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	559 /* Adjust the actual read pointer before the copy is done. */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	560 pipe -> pi_read = destination;
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	561
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	562 /* Copy the message into the pipe area. */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	563 i = (INT) size;
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	564 do
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	565 {
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	566 (destination++) = (source);
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	567 if ((--i) == 0)
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	568 break;
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	569 source++;
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	570 } while (1);
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	571 }
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	572 else
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	573 {
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	574
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	575 /* Variable-length message pipe. */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	576
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	577 /* Calculate the number of bytes remaining from the write
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	578 pointer to the bottom of the pipe. */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	579 copy_size = destination - pipe -> pi_start;
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	580
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	581 /* Determine if part of the message needs to be placed at the
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	582 bottom of the pipe area. */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	583 if (copy_size < (size + i))
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	584
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	585 /* Compute the starting location for the message. */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	586 destination = pipe -> pi_end - ((size + i) - copy_size);
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	587 else
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	588
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	589 /* Compute the starting location for the message. */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	590 destination = destination - (size + i);
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	591
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	592 /* Adjust the actual pipe read pointer also. */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	593 pipe -> pi_read = destination;
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	594
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	595 /* Place message size in first location. */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	596 ((UNSIGNED ) destination) = size;
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	597 destination = destination + sizeof(UNSIGNED);
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	598
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	599 /* Check for a wrap-around condition on the pipe. */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	600 if (destination >= pipe -> pi_end)
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	601
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	602 /* Wrap the write pointer back to the top of the pipe
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	603 area. */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	604 destination = pipe -> pi_start;
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	605
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	606 /* Decrement the number of bytes remaining for this
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	607 extra word of overhead. */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	608 pipe -> pi_available = pipe -> pi_available -
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	609 sizeof(UNSIGNED);
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	610
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	611 /* Calculate the number of bytes remaining from the write
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	612 pointer to the bottom of the pipe. */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	613 copy_size = pipe -> pi_end - destination;
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	614
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	615 /* Determine if the message needs to be wrapped around the
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	616 edge of the pipe area. */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	617 if (copy_size >= (size + pad))
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	618 {
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	619
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	620 /* Copy the whole message at once. */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	621 i = (INT) size;
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	622 do
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	623 {
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	624 (destination++) = (source);
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	625 if ((--i) == 0)
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	626 break;
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	627 source++;
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	628 } while (1);
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	629 }
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	630 else
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	631 {
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	632
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	633 /* Copy the first half of the message. */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	634 i = (INT) copy_size;
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	635 do
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	636 {
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	637 (destination) = (source++);
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	638 if ((--i) == 0)
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	639 break;
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	640 destination++;
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	641 } while (1);
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	642
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	643 /* Copy the second half of the message. */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	644 destination = pipe -> pi_start;
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	645
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	646 /* Determine if there is anything left to copy. */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	647 if (size > copy_size)
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	648 {
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	649 /* Yes, there is something to copy. */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	650 i = (INT) (size - copy_size);
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	651 do
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	652 {
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	653 (destination++) = (source);
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	654 if ((--i) == 0)
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	655 break;
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	656 source++;
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	657 } while (1);
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	658 }
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	659 }
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	660 /* Decrement the number of available bytes. */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	661 pipe -> pi_available = pipe -> pi_available - pad;
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	662 }
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	663
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	664 /* Decrement the number of available bytes. */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	665 pipe -> pi_available = pipe -> pi_available - size;
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	666
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	667 /* Increment the number of messages in the pipe. */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	668 pipe -> pi_messages++;
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	669
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	670 #ifdef INCLUDE_PROVIEW
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	671 _RTProf_DumpPipe(RT_PROF_SEND_TO_FRONT_OF_PIPE,pipe,RT_PROF_OK);
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	672 #endif /* INCLUDE_PROVIEW */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	673
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	674 }
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	675 }
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	676
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	677 /* Release protection against access to the pipe. */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	678 TCT_Unprotect();
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	679
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	680 /* Return to user mode */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	681 NU_USER_MODE();
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	682
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	683 /* Return the completion status. */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	684 return(status);
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	685 }
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	686
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	687
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	688 /*************************************************************************/
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	689 /* */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	690 /* FUNCTION */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	691 /* */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	692 /* PIS_Broadcast_To_Pipe */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	693 /* */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	694 /* DESCRIPTION */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	695 /* */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	696 /* This function sends a message to all tasks waiting for a message */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	697 /* from the specified pipe. If there are no tasks waiting for a */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	698 /* message the service performs like a standard send request. */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	699 /* */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	700 /* CALLED BY */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	701 /* */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	702 /* Application */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	703 /* PISE_Broadcast_To_Pipe Error checking shell */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	704 /* */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	705 /* CALLS */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	706 /* */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	707 /* CSC_Place_On_List Place on suspend list */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	708 /* CSC_Priority_Place_On_List Place on priority list */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	709 /* CSC_Remove_From_List Remove from suspend list */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	710 /* [HIC_Make_History_Entry] Make entry in history log */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	711 /* TCC_Resume_Task Resume a suspended task */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	712 /* TCC_Suspend_Task Suspend calling task */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	713 /* TCC_Task_Priority Pickup task's priority */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	714 /* [TCT_Check_Stack] Stack checking function */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	715 /* TCT_Control_To_System Transfer control to system */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	716 /* TCT_Current_Thread Pickup current thread pointer*/
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	717 /* TCT_System_Protect Protect pipe */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	718 /* TCT_Unprotect Release protection */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	719 /* */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	720 /* INPUTS */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	721 /* */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	722 /* pipe_ptr Pipe control block pointer */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	723 /* message Pointer to message to send */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	724 /* size Size of message to send */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	725 /* suspend Suspension option if full */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	726 /* */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	727 /* OUTPUTS */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	728 /* */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	729 /* NU_SUCCESS If service is successful */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	730 /* NU_PIPE_FULL If pipe is currently full */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	731 /* NU_TIMEOUT If timeout on service expires*/
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	732 /* NU_PIPE_DELETED If pipe was deleted during */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	733 /* suspension */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	734 /* NU_PIPE_RESET If pipe was reset during */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	735 /* suspension */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	736 /* */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	737 /* HISTORY */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	738 /* */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	739 /* DATE REMARKS */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	740 /* */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	741 /* 03-01-1993 Created initial version 1.0 */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	742 /* 04-19-1993 Verified version 1.0 */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	743 /* 03-01-1994 Changed function interfaces to */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	744 /* match those in prototype, */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	745 /* added register options, changed */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	746 /* protection logic to reduce */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	747 /* overhead, optimized copy loop, */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	748 /* resulting in version 1.1 */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	749 /* */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	750 /* 03-18-1994 Verified version 1.1 */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	751 /* */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	752 /*************************************************************************/
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	753 STATUS PIS_Broadcast_To_Pipe(NU_PIPE pipe_ptr, VOID message,
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	754 UNSIGNED size, UNSIGNED suspend)
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	755 {
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	756
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	757 R1 PI_PCB pipe; / Pipe control block ptr */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	758 PI_SUSPEND suspend_block; /* Allocate suspension block */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	759 PI_SUSPEND suspend_ptr; / Pointer to suspend block */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	760 R2 BYTE_PTR source; /* Pointer to source */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	761 R3 BYTE_PTR destination; /* Pointer to destination */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	762 UNSIGNED copy_size; /* Partial copy size */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	763 UNSIGNED pad = 0; /* Number of pad bytes */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	764 R4 INT i; /* Working counter */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	765 TC_TCB task; / Task pointer */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	766 STATUS preempt; /* Preempt flag */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	767 STATUS status; /* Completion status */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	768 NU_SUPERV_USER_VARIABLES
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	769
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	770 /* Switch to supervisor mode */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	771 NU_SUPERVISOR_MODE();
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	772
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	773 /* Move input pipe pointer into internal pointer. */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	774 pipe = (PI_PCB *) pipe_ptr;
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	775
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	776
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	777 #ifdef NU_ENABLE_STACK_CHECK
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	778
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	779 /* Call stack checking function to check for an overflow condition. */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	780 TCT_Check_Stack();
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	781
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	782 #endif
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	783
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	784 #ifdef NU_ENABLE_HISTORY
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	785
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	786 /* Make an entry that corresponds to this function in the system history
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	787 log. */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	788 HIC_Make_History_Entry(NU_BROADCAST_TO_PIPE_ID, (UNSIGNED) pipe,
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	789 (UNSIGNED) message, (UNSIGNED) size);
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	790
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	791 #endif
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	792
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	793 /* Initialize the status as successful. */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	794 status = NU_SUCCESS;
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	795
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	796 /* Protect against simultaneous access to the pipe. */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	797 TCT_System_Protect();
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	798
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	799 /* Determine if an extra word of overhead needs to be added to the
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	800 calculation. */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	801 if (pipe -> pi_fixed_size)
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	802
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	803 /* No overhead. */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	804 i = 0;
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	805 else
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	806 {
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	807
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	808 /* Variable messages have one additional word of overhead. */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	809 i = sizeof(UNSIGNED);
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	810
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	811 /* Calculate the number of pad bytes necessary to keep the pipe
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	812 write pointer on an UNSIGNED data element alignment. */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	813 pad = (((size + sizeof(UNSIGNED) - 1)/sizeof(UNSIGNED)) *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	814 sizeof(UNSIGNED)) - size;
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	815
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	816 /* Insure that padding is included in the overhead. */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	817 i = i + ((INT) pad);
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	818
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	819 /* Make special check to see if a suspension needs to be
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	820 forced for a variable length message. */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	821 if ((pipe -> pi_suspension_list) && (pipe -> pi_messages))
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	822 {
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	823
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	824 /* Pickup task control block pointer. */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	825 task = (TC_TCB *) TCT_Current_Thread();
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	826
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	827 /* Now we know that there are other task(s) are suspended trying
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	828 to send a variable length message. Determine whether or not
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	829 a suspension should be forced. */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	830 if ((pipe -> pi_fifo_suspend) \|\|
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	831 (suspend == NU_NO_SUSPEND) \|\|
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	832 ((pipe -> pi_suspension_list) -> pi_suspend_link.cs_priority <=
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	833 TCC_Task_Priority(task)))
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	834
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	835 /* Bump the computed size to avoid placing the new variable
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	836 length message ahead of the suspended tasks. */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	837 i = (INT) pipe -> pi_available;
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	838 }
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	839 }
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	840
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	841 /* Determine if there is enough room in the pipe for the message. */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	842 if (pipe -> pi_available < (size + i))
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	843 {
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	844
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	845 /* pipe does not have room for the message. Determine if
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	846 suspension is required. */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	847 if (suspend)
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	848 {
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	849
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	850 /* Suspension is requested. */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	851
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	852 /* Increment the number of tasks waiting. */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	853 pipe -> pi_tasks_waiting++;
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	854
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	855 #ifdef INCLUDE_PROVIEW
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	856 _RTProf_DumpPipe(RT_PROF_BROADCAST_TO_PIPE,pipe,RT_PROF_WAIT);
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	857 #endif /* INCLUDE_PROVIEW */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	858
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	859 /* Setup the suspend block and suspend the calling task. */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	860 suspend_ptr = &suspend_block;
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	861 suspend_ptr -> pi_pipe = pipe;
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	862 suspend_ptr -> pi_suspend_link.cs_next = NU_NULL;
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	863 suspend_ptr -> pi_suspend_link.cs_previous = NU_NULL;
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	864 suspend_ptr -> pi_message_area = (BYTE_PTR) message;
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	865 suspend_ptr -> pi_message_size = size;
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	866 task = (TC_TCB *) TCT_Current_Thread();
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	867 suspend_ptr -> pi_suspended_task = task;
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	868
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	869 /* Determine if priority or FIFO suspension is associated with the
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	870 pipe. */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	871 if (pipe -> pi_fifo_suspend)
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	872 {
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	873
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	874 /* FIFO suspension is required. Link the suspend block into
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	875 the list of suspended tasks on this pipe. */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	876 CSC_Place_On_List((CS_NODE **) &(pipe -> pi_suspension_list),
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	877 &(suspend_ptr -> pi_suspend_link));
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	878 }
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	879 else
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	880 {
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	881
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	882 /* Get the priority of the current thread so the suspend block
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	883 can be placed in the appropriate place. */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	884 suspend_ptr -> pi_suspend_link.cs_priority =
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	885 TCC_Task_Priority(task);
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	886
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	887 CSC_Priority_Place_On_List((CS_NODE **)
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	888 &(pipe -> pi_suspension_list),
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	889 &(suspend_ptr -> pi_suspend_link));
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	890 }
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	891
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	892 /* Finally, suspend the calling task. Note that the suspension call
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	893 automatically clears the protection on the pipe. */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	894 TCC_Suspend_Task((NU_TASK *) task, NU_PIPE_SUSPEND,
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	895 PIC_Cleanup, suspend_ptr, suspend);
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	896
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	897 /* Pickup the return status. */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	898 status = suspend_ptr -> pi_return_status;
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	899 }
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	900 else
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	901 {
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	902
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	903 /* Return a status of NU_PIPE_FULL because there is no
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	904 room in the pipe for the message. */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	905 status = NU_PIPE_FULL;
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	906
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	907
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	908 #ifdef INCLUDE_PROVIEW
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	909 _RTProf_DumpPipe(RT_PROF_BROADCAST_TO_PIPE,pipe,RT_PROF_FAIL);
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	910 #endif /* INCLUDE_PROVIEW */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	911
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	912 }
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	913 }
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	914 else
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	915 {
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	916
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	917 #ifdef INCLUDE_PROVIEW
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	918 _RTProf_DumpPipe(RT_PROF_BROADCAST_TO_PIPE,pipe,RT_PROF_OK);
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	919 #endif /* INCLUDE_PROVIEW */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	920
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	921 /* Determine if a task is waiting on an empty pipe. */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	922 if ((pipe -> pi_suspension_list) && (pipe -> pi_messages == 0))
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	923 {
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	924
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	925 /* Yes, one or more tasks are waiting for a message from this
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	926 pipe. */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	927 preempt = 0;
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	928 do
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	929 {
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	930
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	931 /* Decrement the number of tasks waiting on pipe. */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	932 pipe -> pi_tasks_waiting--;
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	933
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	934 /* Remove the first suspended block from the list. */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	935 suspend_ptr = pipe -> pi_suspension_list;
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	936 CSC_Remove_From_List((CS_NODE **)
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	937 &(pipe -> pi_suspension_list),
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	938 &(suspend_ptr -> pi_suspend_link));
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	939
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	940 /* Setup the source and destination pointers. */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	941 source = (BYTE_PTR) message;
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	942 destination = suspend_ptr -> pi_message_area;
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	943
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	944 /* Initialize the return status. */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	945 suspend_ptr -> pi_return_status = NU_SUCCESS;
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	946
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	947 /* Loop to actually copy the message. */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	948 i = (INT) size;
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	949 do
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	950 {
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	951 (destination++) = (source);
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	952 if ((--i) == 0)
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	953 break;
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	954 source++;
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	955 } while (1);
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	956
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	957 /* Return the size of the message copied. */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	958 suspend_ptr -> pi_actual_size = size;
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	959
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	960 /* Wakeup the waiting task and check for preemption. */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	961 preempt = preempt \|
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	962 TCC_Resume_Task((NU_TASK *) suspend_ptr -> pi_suspended_task,
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	963 NU_PIPE_SUSPEND);
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	964
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	965 /* Move the suspend pointer to the next node, which is now
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	966 at the head of the list. */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	967 suspend_ptr = pipe -> pi_suspension_list;
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	968 } while (suspend_ptr);
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	969
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	970 /* Determine if preemption needs to take place. */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	971 if (preempt)
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	972
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	973 /* Transfer control to the system if the resumed task function
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	974 detects a preemption condition. */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	975 TCT_Control_To_System();
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	976 }
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	977 else
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	978 {
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	979
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	980 /* There is enough room in the pipe and no task is waiting. */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	981
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	982 /* Setup the source pointer. */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	983 source = (BYTE_PTR) message;
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	984 destination = pipe -> pi_write;
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	985
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	986 /* Process according to the type of message supported. */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	987 if (pipe -> pi_fixed_size)
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	988 {
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	989
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	990 /* Fixed-size messages are supported by this pipe. */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	991
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	992 /* Loop to copy the message into the pipe area. */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	993 i = (INT) size;
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	994 do
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	995 {
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	996 (destination++) = (source);
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	997 if ((--i) == 0)
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	998 break;
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	999 source++;
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1000 } while (1);
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1001 }
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1002 else
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1003 {
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1004
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1005 /* Variable-size messages are supported. Processing must
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1006 check for pipe wrap-around conditions. */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1007
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1008 /* Place message size in first location. */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1009 ((UNSIGNED ) destination) = size;
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1010 destination = destination + sizeof(UNSIGNED);
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1011
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1012 /* Check for a wrap-around condition on the pipe. */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1013 if (destination >= pipe -> pi_end)
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1014
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1015 /* Wrap the write pointer back to the top of the pipe
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1016 area. */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1017 destination = pipe -> pi_start;
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1018
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1019 /* Decrement the number of bytes remaining for this
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1020 extra word of overhead. */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1021 pipe -> pi_available = pipe -> pi_available -
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1022 sizeof(UNSIGNED);
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1023
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1024 /* Calculate the number of bytes remaining from the write
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1025 pointer to the bottom of the pipe. */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1026 copy_size = pipe -> pi_end - destination;
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1027
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1028 /* Determine if the message needs to be wrapped around the
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1029 edge of the pipe area. */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1030 if (copy_size >= size)
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1031 {
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1032
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1033 /* Copy the whole message at once. */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1034 i = (INT) size;
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1035 do
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1036 {
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1037 (destination++) = (source);
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1038 if ((--i) == 0)
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1039 break;
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1040 source++;
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1041 } while (1);
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1042 }
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1043 else
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1044 {
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1045
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1046 /* Copy the first half of the message. */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1047 i = (INT) copy_size;
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1048 do
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1049 {
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1050 (destination) = (source++);
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1051 if ((--i) == 0)
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1052 break;
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1053 destination++;
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1054 } while (1);
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1055
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1056 /* Copy the second half of the message. */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1057 destination = pipe -> pi_start;
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1058 i = (INT) (size - copy_size);
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1059 do
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1060 {
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1061 (destination++) = (source);
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1062 if ((--i) == 0)
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1063 break;
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1064 source++;
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1065 } while (1);
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1066 }
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1067 }
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1068
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1069 /* Check again for wrap-around condition on the write pointer. */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1070 if (destination >= pipe -> pi_end)
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1071
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1072 /* Move the write pointer to the top of the pipe area. */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1073 destination = pipe -> pi_start;
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1074
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1075 /* Determine if the pipe supports variable-length messages. If
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1076 so, pad bytes are needed to keep UNSIGNED alignment. */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1077 if (pad)
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1078 {
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1079
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1080 /* Variable-size message. Add pad bytes to the write
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1081 pointer. */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1082
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1083 /* Calculate the number of bytes remaining from the write
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1084 pointer to the bottom of the pipe. */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1085 copy_size = pipe -> pi_end - destination;
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1086
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1087 /* If there is not enough room at the bottom of the pipe, the
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1088 pad bytes must be wrapped around to the top. */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1089 if (copy_size <= pad)
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1090
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1091 /* Move write pointer to the top of the pipe and make the
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1092 necessary adjustment. */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1093 destination = pipe -> pi_start + (pad - copy_size);
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1094 else
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1095
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1096 /* There is enough room in the pipe to simply add the
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1097 the pad bytes to the write pointer. */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1098 destination = destination + pad;
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1099
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1100 /* Decrement the number of available bytes. */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1101 pipe -> pi_available = pipe -> pi_available - pad;
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1102 }
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1103
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1104 /* Update the actual write pointer. */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1105 pipe -> pi_write = destination;
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1106
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1107 /* Decrement the number of available bytes. */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1108 pipe -> pi_available = pipe -> pi_available - size;
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1109
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1110 /* Increment the number of messages in the pipe. */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1111 pipe -> pi_messages++;
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1112 }
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1113 }
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1114
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1115 /* Release protection against access to the pipe. */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1116 TCT_Unprotect();
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1117
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1118 /* Return to user mode */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1119 NU_USER_MODE();
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1120
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1121 /* Return the completion status. */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1122 return(status);
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1123 }
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1124
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1125
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1126
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1127
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1128
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1129
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1130

FreeCalypso > hg > freecalypso-sw

annotate gsm-fw/nucleus/pis.c @ 671:210268d8e553