fc-tourmaline: src/g23m-fad/l2r/l2r

annotate src/g23m-fad/l2r/l2r_upf.c @ 19:aa868a5dcfd7

blobs: very few!

author	Mychaela Falconia <falcon@freecalypso.org>
date	Fri, 16 Oct 2020 07:38:28 +0000
parents	fa8dc04885d8
children

rev	line source
1 fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1 /*
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	2 +-----------------------------------------------------------------------------
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	3 \| Project : CSD (8411)
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	4 \| Modul : L2r_upf.c
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	5 +-----------------------------------------------------------------------------
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	6 \| Copyright 2002 Texas Instruments Berlin, AG
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	7 \| All rights reserved.
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	8 \|
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	9 \| This file is confidential and a trade secret of Texas
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	10 \| Instruments Berlin, AG
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	11 \| The receipt of or possession of this file does not convey
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	12 \| any rights to reproduce or disclose its contents or to
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	13 \| manufacture, use, or sell anything it may describe, in
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	14 \| whole, or in part, without the specific written consent of
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	15 \| Texas Instruments Berlin, AG.
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	16 +-----------------------------------------------------------------------------
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	17 \| Purpose : This Modul defines the procedures and functions for
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	18 \| the component L2R of the base station
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	19 +-----------------------------------------------------------------------------
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	20 */
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	21
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	22 #ifndef L2R_UPF_C
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	23 #define L2R_UPF_C
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	24 #endif
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	25
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	26 #define ENTITY_L2R
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	27
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	28 /==== INCLUDES ===================================================/
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	29
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	30 #include <string.h>
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	31 #include "typedefs.h"
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	32 #include "pconst.cdg"
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	33 #include "vsi.h"
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	34 #include "macdef.h"
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	35 #include "custom.h"
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	36 #include "gsm.h"
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	37 #include "cus_l2r.h"
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	38 #include "cnf_l2r.h"
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	39 #include "mon_l2r.h"
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	40 #include "prim.h"
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	41 #include "pei.h"
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	42 #include "tok.h"
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	43 #include "dti.h" /* functionality of the dti library */
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	44
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	45 #include "cl_ribu.h"
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	46 #include "l2r.h"
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	47
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	48 /==== CONST =======================================================/
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	49
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	50 /==== TYPES =======================================================/
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	51
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	52 /==== VAR EXPORT ==================================================/
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	53
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	54 /==== VAR LOCAL ===================================================/
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	55
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	56 /==== FUNCTIONS ===================================================/
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	57
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	58 /*
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	59 +------------------------------------------------------------------------------
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	60 \| Function : up_init
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	61 +------------------------------------------------------------------------------
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	62 \| Description : initialise the l2r data for the uplink process
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	63 \|
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	64 \| Parameters : -
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	65 \|
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	66 \|
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	67 \| Return : -
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	68 +------------------------------------------------------------------------------
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	69 */
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	70
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	71 GLOBAL void up_init(T_UP *dup)
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	72 {
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	73 register ULONG i;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	74
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	75 TRACE_FUNCTION ("up_init()");
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	76
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	77 dup->FlowCtrlUsed = FALSE;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	78 dup->DnFlow = FL_INACTIVE;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	79 dup->UpFlow = FL_INACTIVE;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	80 dup->ULFlow = FL_INACTIVE;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	81 dup->LLFlow = FL_INACTIVE;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	82 dup->MrgFlow = FL_INACTIVE;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	83 dup->FlowThreshLo = MAX_UPRIM_RIBU_SIZE/2;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	84 dup->FlowThreshHi = 3*MAX_UPRIM_RIBU_SIZE/4;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	85 dup->DataSize = 0;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	86 dup->FrameSize = 0;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	87 dup->OldFrameSize = 0;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	88 dup->FramesPerPrim = L2R_FRAMES_PER_PRIM_MAX;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	89 dup->LastRcvdSa = 0;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	90 dup->LastRcvdSb = 0;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	91 dup->LastSentSa = 0;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	92 dup->LastSentSb = 0;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	93 dup->LastSentFlow = FL_INACTIVE;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	94 dup->StoreDataActive = FALSE;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	95 dup->UrgentMsg = FALSE;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	96 dup->DiscardRemapData = FALSE;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	97 dup->QRemapRead = 0;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	98 dup->QRemapWrite = 0;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	99 dup->BRemapAdr = NULL;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	100 dup->BRemapLen = 0;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	101 dup->BRemapSa = 0;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	102 dup->BRemapSb = 0;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	103 dup->BRemapLastState = 0;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	104 dup->QRemapPrimDesc.prim = NULL;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	105
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	106 for (i = 0; i < MAX_UP_REMAP_QUEUE_SIZE; i++)
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	107 {
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	108 dup->QRemap[i] = NULL;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	109 }
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	110
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	111 for (i = 0; i < UP_REMAP_BUFFER_SIZE; i++)
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	112 {
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	113 dup->BRemap[i] = 0;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	114 }
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	115
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	116 dup->RiBu.idx.depth = MAX_UPRIM_RIBU_SIZE;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	117
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	118 INIT_STATE (UP_UL, IW_IDLE);
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	119 INIT_STATE (UP_LL, ISW_IDLE);
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	120 INIT_STATE (UP, UP_DISCONNECTED);
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	121 }
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	122
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	123 /*
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	124 +------------------------------------------------------------------------------
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	125 \| Function : up_alloc_prim
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	126 +------------------------------------------------------------------------------
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	127 \| Description :
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	128 \|
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	129 \| Parameters : -
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	130 \|
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	131 \|
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	132 \| Return : -
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	133 +------------------------------------------------------------------------------
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	134 */
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	135
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	136
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	137 LOCAL void up_alloc_prim(void)
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	138 {
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	139 T_UP *dup = &l2r_data->up;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	140
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	141 T_PRIM_INDEX m;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	142 T_P_UPRIM_DESCRIPTOR primDesc;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	143 USHORT sduSize;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	144
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	145 TRACE_FUNCTION ("up_alloc_prim()");
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	146
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	147 sduSize = dup->FramesPerPrim * dup->FrameSize * 8;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	148 primDesc = dup->RiBu.primDesc[dup->RiBu.alloc];
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	149 {
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	150 PALLOC_SDU(data_req, RLP_DATA_REQ, sduSize);
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	151 primDesc->prim = data_req;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	152 }
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	153
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	154 #ifdef _SIMULATION_
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	155 /* Clear SDU for test environment */
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	156 {
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	157 UBYTE *p;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	158 UBYTE *pend;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	159 p = &primDesc->prim->sdu.buf[0];
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	160 pend = p + (sduSize >> 3);
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	161 while (p < pend)
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	162 {
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	163 *p++ = 0;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	164 }
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	165 }
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	166 #endif
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	167
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	168 primDesc->prim->sdu.o_buf = 0;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	169 primDesc->prim->sdu.l_buf = sduSize;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	170 primDesc->nFr = dup->FramesPerPrim;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	171 primDesc->index = 0;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	172 primDesc->offset = 0;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	173 primDesc->off_status = 0;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	174 primDesc->full = FALSE;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	175 primDesc->sa = FL_INACTIVE;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	176 primDesc->sb = FL_INACTIVE;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	177 /lint -e416 (Warning -- Likely creation of out-of-bounds) /
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	178 for (m = 0; m != dup->FramesPerPrim; m++)
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	179 {
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	180 (primDesc->adr)[m] = (T_P_L2R_FRAME)(primDesc->prim->sdu.buf +L2R_ENCODING_OFFSET + m dup->FrameSize);
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	181 }
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	182 /lint +e416 (Warning -- Likely creation of out-of-bounds) /
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	183 dup->RiBu.alloc++;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	184 if (dup->RiBu.alloc EQ dup->RiBu.idx.depth)
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	185 {
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	186 dup->RiBu.alloc = 0;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	187 }
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	188 }
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	189
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	190 /*
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	191 +------------------------------------------------------------------------------
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	192 \| Function : up_send_prim_timeout
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	193 +------------------------------------------------------------------------------
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	194 \| Description :
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	195 \|
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	196 \| Parameters : -
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	197 \|
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	198 \|
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	199 \| Return : -
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	200 +------------------------------------------------------------------------------
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	201 */
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	202
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	203
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	204 GLOBAL void up_send_prim_timeout(void)
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	205 {
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	206 T_UP *dup = &l2r_data->up;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	207
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	208 TRACE_FUNCTION ("up_send_prim_timeout()");
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	209
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	210 if (!dup->RiBu.idx.filled)
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	211 {
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	212 if (dup->RiBu.alloc EQ dup->RiBu.idx.wi)
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	213 {
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	214 /* No primitive is there, so we allocate one */
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	215 up_alloc_prim();
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	216 }
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	217
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	218 /*
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	219 No primitive is ready, so we take one away from the relay entity
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	220 */
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	221 cl_ribu_write_index(&dup->RiBu.idx); /* point to next primitive */
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	222 }
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	223 up_send_current_prim();
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	224 }
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	225
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	226 /*
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	227 +------------------------------------------------------------------------------
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	228 \| Function : up_next_remap_frame
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	229 +------------------------------------------------------------------------------
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	230 \| Description : Local function, which is used by up_copy_data_from_l2r
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	231 \| to advance to the next frame in the primitive.
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	232 \| The variable primDesc of the calling function is updated.
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	233 \|
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	234 \| Parameters : primDesc -
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	235 \|
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	236 \| Return : 1 -
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	237 \| 0 -
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	238 +------------------------------------------------------------------------------
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	239 */
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	240
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	241 LOCAL UBYTE up_next_remap_frame(T_RPRIM_DESCRIPTOR *primDesc)
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	242 {
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	243 T_UP *dup = &l2r_data->up;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	244
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	245 U8 i;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	246 T_P_RLP_REMAP_DATA_IND prim;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	247
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	248 /* next frame */
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	249 primDesc->index++;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	250
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	251 if (primDesc->index >= primDesc->nFr)
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	252 {
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	253 /* primitive is completely read out */
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	254 PFREE(dup->QRemap [dup->QRemapRead]);
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	255
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	256 /* next primitive */
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	257 (dup->QRemapRead)++;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	258 if (dup->QRemapRead >= MAX_UP_REMAP_QUEUE_SIZE)
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	259 {
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	260 dup->QRemapRead = 0;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	261 }
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	262 if (dup->QRemapRead EQ dup->QRemapWrite)
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	263 {
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	264 /* no primitive is ready */
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	265 primDesc->prim = NULL;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	266 return (1);
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	267 }
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	268
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	269 /* point to next primitive descriptor */
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	270
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	271 prim = dup->QRemap[dup->QRemapRead];
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	272 primDesc->prim = prim;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	273 primDesc->nFr = prim->sdu.l_buf / (8 * prim->data_size + HT_LEN);
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	274 primDesc->index = 0;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	275
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	276 for (i = 0; i < primDesc->nFr; i++)
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	277 {
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	278 primDesc->adr[i] = (T_P_L2R_FRAME)(prim->sdu.buf + (prim->sdu.o_buf>>3)
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	279 + HEADER_LEN + i * (prim->data_size + HT_LEN));
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	280 }
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	281 }
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	282 primDesc->offset = 0;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	283 primDesc->off_status = 0;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	284 return (0);
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	285 }
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	286
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	287 /*
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	288 +------------------------------------------------------------------------------
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	289 \| Function : up_copy_data_from_rq
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	290 +------------------------------------------------------------------------------
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	291 \| Description :
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	292 \|
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	293 \| Parameters : buf -
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	294 \| len -
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	295 \| sa -
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	296 \| sb -
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	297 \| bytesCopied -
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	298 \|
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	299 \| Return : -
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	300 +------------------------------------------------------------------------------
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	301 */
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	302
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	303 LOCAL void up_copy_data_from_rq(U8 buf, U16 len, U8 sa, U8 sb, U16 bytesCopied)
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	304 {
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	305 T_UP *dup = &l2r_data->up;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	306
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	307 register ULONG i;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	308 register T_P_UBYTE pFrame;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	309 register T_P_UBYTE pBuf;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	310 register T_P_UBYTE pStat;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	311 T_P_RLP_REMAP_DATA_IND prim;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	312 T_P_L2R_FRAME frame;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	313 T_P_UBYTE pEnd;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	314 USHORT bytesToCopy;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	315 USHORT blocklen;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	316 UBYTE statOct;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	317 UBYTE lastState;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	318
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	319 T_RPRIM_DESCRIPTOR *primDesc = &dup->QRemapPrimDesc;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	320
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	321 #ifdef _SIMULATION_
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	322 TRACE_FUNCTION ("up_copy_data_from_rq()");
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	323 #endif
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	324
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	325 bytesToCopy = len;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	326
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	327 if (primDesc->prim EQ NULL)
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	328 {
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	329 prim = dup->QRemap[dup->QRemapRead];
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	330 primDesc->prim = prim;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	331 primDesc->nFr = prim->sdu.l_buf / ((prim->data_size<<3) + HT_LEN);
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	332 primDesc->index = 0;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	333 primDesc->offset = 0;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	334 primDesc->off_status = 0;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	335
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	336 for (i = 0; i < primDesc->nFr; i++)
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	337 {
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	338 primDesc->adr[i] = (T_P_L2R_FRAME)(prim->sdu.buf + (prim->sdu.o_buf>>3)
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	339 + HEADER_LEN + i * (prim->data_size + HT_LEN));
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	340 }
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	341 }
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	342
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	343 /* skip empty primitive */
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	344 if (primDesc->nFr EQ 0)
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	345 {
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	346 *bytesCopied = 0;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	347 return;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	348 }
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	349
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	350 frame = primDesc->adr[primDesc->index]; /* point to current l2r frame in primitive */
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	351 pBuf = buf; /* point to destination buffer */
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	352 pFrame = &((*frame)[primDesc->offset]);
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	353 pStat = &((*frame)[primDesc->off_status]);
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	354
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	355 if (pFrame EQ pStat)
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	356 {
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	357 /* current byte is status octet */
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	358 dup->BRemapLastState = *pFrame & SO_STATUS_BITS_MASK;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	359 }
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	360
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	361 lastState = dup->BRemapLastState;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	362 *sa = GET_SO_SA_BIT(lastState);
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	363 *sb = GET_SO_SB_BIT(lastState);
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	364
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	365 /************************************************************************************
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	366 * loop until either
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	367 * - no more data are available or
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	368 * - status in L2R frame changes or
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	369 * - buffer for data is full
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	370 ************************************************************************************/
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	371
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	372 for (;;)
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	373 {
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	374 #ifdef _SIMULATION_
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	375 TRACE_FUNCTION ("loop");
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	376 #endif
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	377
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	378 blocklen = pStat - pFrame;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	379 if (blocklen EQ 0)
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	380 {
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	381 /*
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	382 * current byte is status octet
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	383 * (only in the first pass of the loop, there may be no status octet)
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	384 */
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	385
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	386 /*****************************
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	387 * evaluate status bits
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	388 *****************************/
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	389 statOct = *pFrame;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	390 if (lastState NEQ (statOct & SO_STATUS_BITS_MASK))
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	391 {
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	392 /*
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	393 * status has changed. We have to stop,
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	394 * since only one state can be transmitted to the upper layer
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	395 */
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	396 primDesc->offset = primDesc->off_status = pFrame - (T_P_UBYTE)frame;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	397
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	398 *bytesCopied = len - bytesToCopy;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	399 return;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	400 }
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	401
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	402 pFrame++;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	403
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	404 /************************************
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	405 * evaluate addrss bits
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	406 ************************************/
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	407 statOct &= SO_ADR_MASK;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	408
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	409 switch (statOct)
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	410 {
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	411 case SO_BREAK_ACK:
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	412 case SO_BREAK_REQ:
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	413 case SO_END_EMPTY:
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	414 /* no more data in this frame */
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	415 if (up_next_remap_frame(primDesc) EQ 1)
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	416 {
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	417 /* no more data available */
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	418 bytesCopied = len - bytesToCopy; / this much data could be copied */
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	419 return;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	420 }
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	421
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	422 frame = primDesc->adr[primDesc->index];
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	423 pFrame = (T_P_UBYTE)frame;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	424 pStat = (T_P_UBYTE)frame;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	425 continue; /* continue with next frame */
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	426
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	427 case SO_END_FULL:
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	428 pStat = &((*frame)[primDesc->prim->data_size]);
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	429 blocklen = pStat - pFrame;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	430 break;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	431
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	432 case SO_TWO_OCTET:
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	433 blocklen = *pFrame++ & SO_ADR_MASK_TWO_OCT;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	434 pStat = pFrame + blocklen;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	435 break;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	436
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	437 default:
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	438 blocklen = statOct;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	439 pStat = pFrame + blocklen;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	440 break;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	441 }
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	442 }
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	443
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	444 if (bytesToCopy < blocklen)
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	445 {
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	446 /***************************************
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	447 * There is not enough space in the
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	448 * buffer to copy the complete block
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	449 ***************************************/
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	450
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	451 pEnd = pFrame + bytesToCopy;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	452
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	453 while (pFrame < pEnd)
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	454 {
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	455 pBuf++ = pFrame++;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	456 }
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	457
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	458 if (pFrame EQ &((*frame)[primDesc->prim->data_size]))
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	459 {
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	460 /* end of frame reached */
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	461 up_next_remap_frame(primDesc);
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	462 }
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	463 else
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	464 {
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	465 primDesc->offset = pFrame - (T_P_UBYTE)frame;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	466 primDesc->off_status = pStat - (T_P_UBYTE)frame;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	467 }
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	468 bytesCopied = len; / this much data could be copied */
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	469 return;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	470 }
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	471 else
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	472 {
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	473 /***************************************
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	474 * Copy the complete block
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	475 ***************************************/
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	476 bytesToCopy -= blocklen;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	477
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	478 while (pFrame < pStat)
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	479 {
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	480 pBuf++ = pFrame++;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	481 }
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	482
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	483 if (pFrame EQ &((*frame)[primDesc->prim->data_size]))
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	484 {
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	485 /* end of frame reached */
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	486 if (up_next_remap_frame(primDesc) EQ 1)
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	487 {
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	488 /* no more data available */
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	489 bytesCopied = len - bytesToCopy; / this much data could be copied */
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	490 return;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	491 }
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	492 frame = primDesc->adr[primDesc->index];
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	493 pFrame = (T_P_UBYTE)frame;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	494 pStat = (T_P_UBYTE)frame;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	495 }
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	496 if (bytesToCopy EQ 0)
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	497 {
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	498 primDesc->offset = pFrame - (T_P_UBYTE)frame;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	499 primDesc->off_status = pStat - (T_P_UBYTE)frame;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	500 bytesCopied = len; / this much data could be copied */
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	501 return;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	502 }
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	503 }
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	504 }
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	505 }
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	506
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	507 /*
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	508 +------------------------------------------------------------------------------
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	509 \| Function : up_fill_in_status_octet
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	510 +------------------------------------------------------------------------------
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	511 \| Description : local function, which is used patch a status octet into a
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	512 \| l2r frame. This function takes into acount the two octet
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	513 \| format for 14400.
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	514 \|
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	515 \| Parameters : pFrame - points to begin of l2r frame
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	516 \| offstat1 - offset of status octet to be patched
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	517 \| offstat2 - offset of next status octet
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	518 \|
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	519 \| Return :
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	520 +------------------------------------------------------------------------------
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	521 */
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	522
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	523 LOCAL BOOL up_fill_in_status_octet(T_P_UBYTE pFrame, UBYTE offstat1, UBYTE offstat2)
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	524 {
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	525 register T_P_UBYTE pStat, pSrc, pDes, pEnd;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	526 register UBYTE dataLen;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	527
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	528 dataLen = offstat2 - offstat1 - 1; /* number of data bytes between status octets */
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	529 pStat = pFrame + offstat1;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	530
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	531 if (dataLen <= DATA_SIZE_SHORT-2)
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	532 {
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	533 *pStat \|= dataLen;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	534 return (FALSE);
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	535 }
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	536 else
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	537 {
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	538 /* this is only possible with 14400 */
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	539 if (offstat2 < DATA_SIZE_LONG - 1)
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	540 {
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	541 /* a two octet status must be inserted */
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	542 pSrc = pFrame + offstat2;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	543 pDes = pSrc + 1;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	544 pEnd = pFrame + offstat1;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	545 while (pSrc > pEnd)
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	546 {
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	547 --pDes = --pSrc;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	548 }
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	549 *pStat \|= SO_TWO_OCTET;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	550 pStat++;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	551 *pStat = dataLen;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	552 }
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	553 else
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	554 {
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	555 /* a additional status octet (FULL) must be inserted somewhere in the frame */
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	556 pSrc = pFrame + offstat2;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	557 pDes = pSrc + 1;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	558 pEnd = pFrame + offstat1 + DATA_SIZE_SHORT - 1;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	559 while (pSrc > pEnd)
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	560 {
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	561 --pDes = --pSrc;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	562 }
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	563 *pStat \|= DATA_SIZE_SHORT - 2;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	564 pEnd = pStat & SO_STATUS_BITS_MASK \| SO_END_FULL;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	565 }
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	566 return (TRUE);
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	567 }
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	568 }
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	569
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	570 /*
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	571 +------------------------------------------------------------------------------
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	572 \| Function : up_next_frame
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	573 +------------------------------------------------------------------------------
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	574 \| Description : local function, which is used by up_copy_data_into_l2r to
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	575 \| advance to the next frame in the primitive
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	576 \| The variables primDesc, frame and pFrame of the calling function
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	577 \| are updated. Moreover the return values of the calling function
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	578 \| primToSend and bytesCopied are set.
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	579 \|
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	580 \|
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	581 \| Parameters : primDesc -
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	582 \| primToSend -
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	583 \|
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	584 \| Return :
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	585 +------------------------------------------------------------------------------
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	586 */
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	587
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	588 LOCAL UBYTE up_next_frame(T_P_UPRIM_DESCRIPTOR primDesc, BOOL primToSend)
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	589 {
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	590 T_UP *dup = &l2r_data->up;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	591
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	592 TRACE_FUNCTION("up_next_frame()");
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	593
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	594 (*primDesc)->index++;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	595 (*primDesc)->offset = 0;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	596
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	597 if ((primDesc)->index >= dup->FramesPerPrim) / primitive is filled */
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	598 {
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	599 (*primDesc)->full = TRUE;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	600 *primToSend = TRUE;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	601
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	602 cl_ribu_write_index(&dup->RiBu.idx); /* point to next primitive */
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	603
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	604 if (dup->RiBu.alloc EQ dup->RiBu.idx.wi)
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	605 {
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	606 /* no primitive is ready */
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	607 return (1);
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	608 }
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	609
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	610 /* point to next primitive descriptor */
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	611 *primDesc = dup->RiBu.primDesc[dup->RiBu.idx.wi];
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	612 (*primDesc)->index = 0;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	613 }
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	614 return (0);
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	615 }
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	616
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	617 LOCAL void up_copy_data_into_l2r(U8 buf, U16 len, U8 sa, U8 sb, U8 x, BOOL primToSend, U16 *bytesCopied)
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	618 {
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	619 T_UP *dup = &l2r_data->up;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	620
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	621 T_P_UPRIM_DESCRIPTOR primDesc;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	622 T_P_L2R_FRAME frame;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	623 register T_P_UBYTE pFrame;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	624 register T_P_UBYTE pEnd;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	625 register T_P_UBYTE pBuf;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	626 USHORT bytesToCopy;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	627 UBYTE frameCount;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	628 T_FLOW flow = FL_INVALID;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	629
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	630 #ifdef _SIMULATION_
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	631 TRACE_FUNCTION ("up_copy_data_into_l2r()");
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	632 #endif
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	633
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	634 switch (x)
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	635 {
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	636 case DTI_FLOW_ON:
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	637 flow = FL_INACTIVE;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	638 break;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	639 case DTI_FLOW_OFF:
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	640 flow = FL_ACTIVE;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	641 break;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	642 }
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	643
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	644 #ifdef _TARGET_
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	645 if (dup->DataSize > DATA_SIZE_SHORT)
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	646 {
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	647 frameCount = 1;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	648 }
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	649 else
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	650 {
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	651 frameCount = 2;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	652 }
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	653 #else
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	654 {
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	655 frameCount = 100;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	656 }
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	657 #endif
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	658
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	659 up_store_status(sa, sb, flow);
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	660
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	661 if (dup->LastSentFlow EQ dup->MrgFlow)
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	662 {
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	663 *primToSend = FALSE;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	664 }
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	665 else
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	666 {
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	667 *primToSend = TRUE;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	668 }
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	669
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	670 /* don't copy into primitive if no primitive is ready */
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	671 if (dup->RiBu.alloc EQ dup->RiBu.idx.wi)
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	672 {
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	673 *bytesCopied = 0;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	674 return;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	675 }
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	676
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	677 bytesToCopy = len;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	678
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	679 primDesc = dup->RiBu.primDesc[dup->RiBu.idx.wi]; /* point to current primitive descriptor */
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	680 frame = (primDesc->adr)[primDesc->index]; / point to current l2r frame in primitive */
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	681 pFrame = &(frame)[primDesc->offset]; / point to current byte in frame */
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	682 pBuf = buf; /* point to source buffer */
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	683
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	684 /************************************************************************************
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	685 *
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	686 * Handle a partly filled frame, which has been written in the primitive previously
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	687 *
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	688 ************************************************************************************/
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	689
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	690 if (primDesc->offset NEQ 0)
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	691 {
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	692 /* partly filled frame is there */
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	693
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	694 if (bytesToCopy EQ 0)
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	695 /* no data to copy -> quit without writing status octet */
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	696 {
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	697 *bytesCopied = len;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	698 return;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	699 }
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	700
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	701 if (sa NEQ primDesc->sa OR sb NEQ primDesc->sb)
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	702 {
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	703 /*
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	704 * status has changed since last time
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	705 */
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	706
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	707 /* finish previous status octet */
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	708 if (
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	709 up_fill_in_status_octet(
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	710 (T_P_UBYTE)frame,
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	711 primDesc->off_status,
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	712 primDesc->offset
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	713 )
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	714 )
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	715 {
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	716 /* frame data has been moved to make space for two octet status */
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	717 pFrame++;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	718 (primDesc->offset)++;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	719
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	720 if (primDesc->offset >= (dup->DataSize))
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	721 {
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	722 /* frame is just filled by patching the previous status frame */
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	723
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	724 if (up_next_frame(&primDesc, primToSend) EQ 1)
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	725 {
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	726 /* no more space for data */
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	727 bytesCopied = 0; / no data could be copied */
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	728 return;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	729 }
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	730 frameCount--;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	731 #ifdef _TARGET_
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	732 if (frameCount EQ 0)
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	733 {
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	734 bytesCopied = 0; / no data could be copied */
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	735 return;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	736 }
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	737 #endif
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	738 frame = (primDesc->adr)[primDesc->index]; / point to current l2r frame in primitive */
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	739 pFrame = &(frame)[primDesc->offset]; / point to current byte in frame */
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	740 }
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	741 }
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	742
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	743 if (primDesc->offset NEQ 0)
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	744 {
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	745 /* write status octet */
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	746 pFrame++ = (U8)(sa << SO_SA_BIT \| sb << SO_SB_BIT \| 0 << SO_X_BIT); / x is set to 0 (inactive) by default */
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	747
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	748 /* store current status for next call */
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	749 primDesc->sa = sa;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	750 primDesc->sb = sb;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	751
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	752 primDesc->off_status = primDesc->offset;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	753 (primDesc->offset)++;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	754 if (primDesc->offset >= (dup->DataSize))
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	755 {
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	756 /* frame is just filled by the status octet */
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	757
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	758 /* finish previous status octet */
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	759 (*frame)[primDesc->off_status] \|= SO_END_EMPTY;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	760
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	761 if (up_next_frame(&primDesc, primToSend) EQ 1)
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	762 {
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	763 /* no more space for data */
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	764 bytesCopied = 0; / no data could be copied */
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	765 return;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	766 }
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	767 frameCount--;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	768 if (frameCount EQ 0)
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	769 {
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	770 bytesCopied = 0; / no data could be copied */
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	771 return;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	772 }
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	773 frame = (primDesc->adr)[primDesc->index]; / point to current l2r frame in primitive */
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	774 pFrame = &(frame)[primDesc->offset]; / point to current byte in frame */
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	775 }
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	776 }
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	777 }
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	778
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	779 /*
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	780 * write data into partly filled frame
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	781 */
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	782 if (primDesc->offset NEQ 0)
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	783 {
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	784 if (bytesToCopy >= dup->DataSize - primDesc->offset)
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	785 {
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	786 /* enough data to fill frame completly */
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	787
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	788 for (pEnd = pFrame + dup->DataSize - primDesc->offset; pFrame < pEnd; )
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	789 {
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	790 pFrame++ = pBuf++;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	791 }
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	792
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	793 /* finish previous status octet */
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	794 (*frame)[primDesc->off_status] \|= SO_END_FULL;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	795
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	796 bytesToCopy -= dup->DataSize - primDesc->offset;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	797
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	798 if (up_next_frame(&primDesc, primToSend) EQ 1)
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	799 {
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	800 /* no more space for data */
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	801 bytesCopied = len - bytesToCopy; / this much data could be copied */
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	802 return;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	803 }
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	804 frameCount--;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	805 if (frameCount EQ 0)
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	806 {
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	807 bytesCopied = len - bytesToCopy; / this much data could be copied */
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	808 return;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	809 }
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	810 frame = (primDesc->adr)[primDesc->index]; / point to current l2r frame in primitive */
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	811 pFrame = &(frame)[primDesc->offset]; / point to current byte in frame */
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	812
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	813 }
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	814 else
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	815 {
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	816 /* not enough data to fill frame completly */
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	817
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	818 for (pEnd = pFrame + bytesToCopy; pFrame < pEnd; )
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	819 {
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	820 pFrame++ = pBuf++;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	821 }
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	822 primDesc->offset += bytesToCopy;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	823 *bytesCopied = len;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	824 return; /* Nothing else to do */
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	825 }
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	826 }
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	827 }
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	828
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	829 /************************************************************************************
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	830 *
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	831 * Handle consecutive frames, which are filled starting with byte 0
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	832 *
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	833 ************************************************************************************/
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	834
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	835 while (bytesToCopy > 0)
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	836 {
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	837 if (bytesToCopy >= dup->DataSize - 1)
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	838 {
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	839 /*
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	840 * There are enough data to fill a frame completely
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	841 */
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	842 pFrame++ = sa << SO_SA_BIT \| sb << SO_SB_BIT \| 0 << SO_X_BIT \| SO_END_FULL; / x is set to 0 (inactive) by default */
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	843
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	844 /* store current status for next call */
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	845 primDesc->sa = sa;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	846 primDesc->sb = sb;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	847
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	848 for (pEnd = pFrame + dup->DataSize - 1; pFrame < pEnd; )
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	849 {
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	850 pFrame++ = pBuf++;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	851 }
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	852 bytesToCopy -= dup->DataSize - 1;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	853
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	854 /* advance to next frame */
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	855 if (up_next_frame(&primDesc, primToSend) EQ 1)
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	856 {
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	857 /* running out of primitives */
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	858 bytesCopied = len - bytesToCopy; / this much data could be copied */
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	859 return;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	860 }
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	861 frameCount--;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	862 if (frameCount EQ 0)
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	863 {
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	864 bytesCopied = len - bytesToCopy; / this much data could be copied */
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	865 return;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	866 }
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	867 frame = (primDesc->adr)[primDesc->index]; / point to current l2r frame in primitive */
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	868 pFrame = &(frame)[primDesc->offset]; / point to current byte in frame */
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	869 }
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	870 else
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	871 {
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	872 /*
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	873 * There are some data, but not enough to fill a frame completely
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	874 */
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	875 pFrame++ = (U8)(sa << SO_SA_BIT \| sb << SO_SB_BIT \| 0 << SO_X_BIT); / x is set to 0 (inactive) by default */
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	876
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	877 /* store current status for next call */
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	878 primDesc->sa = sa;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	879 primDesc->sb = sb;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	880
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	881 for (pEnd = pFrame + bytesToCopy; pFrame < pEnd; )
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	882 {
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	883 pFrame++ = pBuf++;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	884 }
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	885 primDesc->off_status = 0;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	886 primDesc->offset = bytesToCopy + 1;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	887 bytesToCopy = 0;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	888 }
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	889 }
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	890 *bytesCopied = len;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	891 }
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	892
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	893 /*
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	894 +------------------------------------------------------------------------------
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	895 \| Function : up_copy_remap_data
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	896 +------------------------------------------------------------------------------
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	897 \| Description :
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	898 \|
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	899 \| Parameters : -
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	900 \|
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	901 \|
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	902 \| Return : -
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	903 +------------------------------------------------------------------------------
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	904 */
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	905
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	906 LOCAL void up_copy_remap_data(void)
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	907 {
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	908 T_UP *dup = &l2r_data->up;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	909
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	910 USHORT bytesCopied;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	911 BOOL dummy;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	912
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	913 #ifdef _SIMULATION_
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	914 TRACE_FUNCTION ("up_copy_remap_data()");
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	915 #endif
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	916
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	917 do
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	918 {
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	919 if (dup->BRemapLen EQ 0)
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	920 {
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	921 dup->BRemapAdr = dup->BRemap;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	922 up_copy_data_from_rq
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	923 (
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	924 dup->BRemapAdr,
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	925 UP_REMAP_BUFFER_SIZE,
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	926 &dup->BRemapSa,
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	927 &dup->BRemapSb,
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	928 &dup->BRemapLen
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	929 );
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	930 if (dup->BRemapLen EQ 0)
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	931 {
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	932 up_check_flow();
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	933 return;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	934 }
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	935 }
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	936 up_copy_data_into_l2r
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	937 (
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	938 dup->BRemapAdr,
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	939 dup->BRemapLen,
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	940 dup->BRemapSa,
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	941 dup->BRemapSb,
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	942 DTI_FLOW_OFF,
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	943 &dummy,
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	944 &bytesCopied
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	945 );
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	946 dup->BRemapAdr += bytesCopied;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	947 dup->BRemapLen -= bytesCopied;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	948
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	949 } while (bytesCopied NEQ 0);
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	950 }
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	951
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	952 /*
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	953 +------------------------------------------------------------------------------
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	954 \| Function : up_check_alloc
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	955 +------------------------------------------------------------------------------
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	956 \| Description : This procedure allocates new primitives until there are
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	957 \| UP_RIBU_PREALLOC primitives ready.
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	958 \|
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	959 \| I.e.: alloc = write + UP_RIBU_PREALLOC
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	960 \|
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	961 \| It may be less than this, if otherwise the alloc pointer
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	962 \| would reach the read pointer.
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	963 \|
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	964 \|
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	965 \| Parameters : -
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	966 \|
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	967 \|
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	968 \| Return : -
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	969 +------------------------------------------------------------------------------
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	970 */
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	971
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	972 GLOBAL void up_check_alloc(void)
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	973 {
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	974 T_UP *dup = &l2r_data->up;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	975
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	976 S8 i_from, i_to;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	977
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	978 TRACE_FUNCTION ("up_check_alloc()");
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	979
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	980 i_to = dup->RiBu.idx.ri - dup->RiBu.idx.wi - 1;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	981
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	982 if (i_to < 0)
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	983 {
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	984 i_to = i_to + dup->RiBu.idx.depth;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	985 }
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	986
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	987 if (i_to > UP_RIBU_PREALLOC)
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	988 {
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	989 i_to = UP_RIBU_PREALLOC;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	990 }
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	991
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	992 i_from = dup->RiBu.alloc - dup->RiBu.idx.wi;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	993
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	994 if (i_from < 0)
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	995 {
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	996 i_from = i_from + dup->RiBu.idx.depth;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	997 }
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	998
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	999 if (i_from >= i_to)
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1000 {
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1001 return;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1002 }
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1003
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1004 do
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1005 {
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1006 up_alloc_prim();
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1007 i_from++;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1008 } while (i_from < i_to);
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1009
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1010 if (dup->QRemapRead NEQ dup->QRemapWrite)
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1011 {
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1012 up_copy_remap_data();
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1013 return;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1014 }
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1015
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1016 switch (GET_STATE (UP_UL))
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1017 {
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1018 case IW_WAIT:
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1019 break;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1020
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1021 case IW_IDLE:
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1022 if (dup->StoreDataActive EQ FALSE AND dup->Prim NEQ NULL)
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1023 {
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1024 up_store_data();
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1025 }
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1026 break;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1027 }
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1028 }
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1029
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1030 /*
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1031 +------------------------------------------------------------------------------
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1032 \| Function : up_check_flow
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1033 +------------------------------------------------------------------------------
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1034 \| Description :
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1035 \|
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1036 \| Parameters : -
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1037 \|
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1038 \|
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1039 \| Return : -
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1040 +------------------------------------------------------------------------------
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1041 */
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1042
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1043 GLOBAL void up_check_flow(void)
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1044 {
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1045 T_UP *dup = &l2r_data->up;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1046
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1047 U8 primCount;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1048
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1049 TRACE_FUNCTION ("up_check_flow()");
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1050
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1051 if (!dup->FlowCtrlUsed)
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1052 {
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1053 return;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1054 }
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1055
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1056 primCount = dup->RiBu.idx.filled;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1057
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1058 switch (dup->UpFlow)
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1059 {
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1060 case FL_ACTIVE:
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1061 if (primCount < dup->FlowThreshLo)
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1062 {
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1063 dup->UpFlow = FL_INACTIVE;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1064 }
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1065 else
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1066 {
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1067 return;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1068 }
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1069 break;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1070
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1071 case FL_INACTIVE:
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1072 if (primCount >= dup->FlowThreshHi)
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1073 {
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1074 dup->UpFlow = FL_ACTIVE;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1075 }
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1076 else
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1077 {
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1078 return;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1079 }
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1080 break;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1081 }
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1082 sig_up_dn_flow(dup->UpFlow);
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1083 }
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1084
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1085 /*
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1086 +------------------------------------------------------------------------------
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1087 \| Function : up_store_data
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1088 +------------------------------------------------------------------------------
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1089 \| Description : This procedure copies data from a dti_data_req primitive
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1090 \| into the uplink ring buffer.
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1091 \|
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1092 \|
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1093 \| Parameters : -
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1094 \|
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1095 \|
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1096 \| Return : -
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1097 +------------------------------------------------------------------------------
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1098 */
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1099
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1100 GLOBAL void up_store_data(void)
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1101 {
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1102 T_UP *dup = &l2r_data->up;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1103
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1104 T_P_UBYTE adr;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1105 USHORT len;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1106 BOOL primToSend;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1107 USHORT bytesCopied;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1108 USHORT i, j;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1109 T_desc2 *desc;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1110
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1111 TRACE_FUNCTION ("up_store_data()");
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1112
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1113 dup->StoreDataActive = TRUE;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1114
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1115 do
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1116 {
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1117 desc = (T_desc2*)dup->Prim->desc_list2.first;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1118 if (desc)
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1119 {
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1120 len = desc->len;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1121 adr = desc->buffer;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1122 }
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1123 else
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1124 {
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1125 len = 0;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1126 adr = NULL;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1127 }
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1128
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1129 up_copy_data_into_l2r (adr,
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1130 len,
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1131 dup->Prim->parameters.st_lines.st_line_sa,
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1132 dup->Prim->parameters.st_lines.st_line_sb,
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1133 dup->Prim->parameters.st_lines.st_flow,
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1134 &primToSend,
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1135 &bytesCopied);
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1136
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1137 dup->Prim->desc_list2.list_len -= bytesCopied;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1138
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1139 if (desc)
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1140 {
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1141 if ((bytesCopied EQ len))
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1142 {
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1143 /*
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1144 * Block has been copied successfully
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1145 */
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1146 dup->Prim->desc_list2.first = desc->next;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1147 MFREE (desc);
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1148 }
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1149 else if (bytesCopied > 0)
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1150 {
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1151 /*
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1152 * remaining data must be copied to begin of block
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1153 */
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1154 /lint -e{661} (Warning -- Likely creation of out-of-bounds) /
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1155 for (i=0, j = bytesCopied; j < len; i++, j++)
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1156 {
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1157 desc->buffer[i] = desc->buffer[j];
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1158 }
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1159 desc->len -= bytesCopied;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1160 }
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1161 }
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1162 up_check_alloc();
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1163
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1164 } while (dup->Prim->desc_list2.first NEQ 0 AND dup->RiBu.alloc NEQ dup->RiBu.idx.wi);
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1165
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1166 if (dup->Prim->desc_list2.first EQ 0)
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1167 {
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1168 PFREE (dup->Prim);
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1169 dup->Prim = NULL;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1170 up_send_ready();
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1171 }
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1172 dup->StoreDataActive = FALSE;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1173 }
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1174
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1175 /*
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1176 +------------------------------------------------------------------------------
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1177 \| Function : up_send_ready
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1178 +------------------------------------------------------------------------------
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1179 \| Description : only used in test environment
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1180 \|
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1181 \| Parameters : -
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1182 \|
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1183 \|
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1184 \| Return : -
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1185 +------------------------------------------------------------------------------
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1186 */
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1187
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1188 GLOBAL void up_send_ready(void)
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1189 {
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1190 TRACE_FUNCTION ("up_send_ready()");
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1191
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1192 if (GET_STATE (UP_UL) EQ IW_IDLE)
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1193 {
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1194 if (l2r_data->up.DtiConnected EQ FALSE)
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1195 {
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1196 TRACE_EVENT("DTI not connected, but up_send_ready() called -> break");
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1197 return; /* jk: DTI_READY_IND primitive cannot be sent when DTI disconnected (!) */
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1198 }
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1199
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1200 dti_start (
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1201 l2r_hDTI,
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1202 L2R_DTI_UP_DEF_INSTANCE,
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1203 L2R_DTI_UP_INTERFACE,
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1204 L2R_DTI_UP_CHANNEL
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1205 );
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1206 SET_STATE (UP_UL, IW_WAIT);
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1207 }
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1208 }
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1209
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1210 LOCAL void clear_primDesc(T_P_UPRIM_DESCRIPTOR primDesc)
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1211 {
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1212 primDesc->prim = NULL;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1213
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1214 primDesc->nFr = 0;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1215 primDesc->index = 0;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1216 primDesc->offset = 0;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1217 primDesc->off_status = 0;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1218 primDesc->full = FALSE;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1219 primDesc->sa = FL_INACTIVE;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1220 primDesc->sb = FL_INACTIVE;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1221 }
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1222
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1223 /*
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1224 +------------------------------------------------------------------------------
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1225 \| Function : up_free_prim
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1226 +------------------------------------------------------------------------------
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1227 \| Description :
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1228 \|
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1229 \| Parameters : primDesc
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1230 \|
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1231 \|
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1232 \| Return : -
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1233 +------------------------------------------------------------------------------
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1234 */
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1235
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1236 LOCAL void up_free_prim(T_P_UPRIM_DESCRIPTOR primDesc)
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1237 {
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1238 TRACE_FUNCTION ("up_free_prim()");
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1239
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1240 if (primDesc->prim NEQ NULL)
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1241 {
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1242 PFREE (primDesc->prim);
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1243 clear_primDesc(primDesc);
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1244 }
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1245 }
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1246
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1247 /*
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1248 +------------------------------------------------------------------------------
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1249 \| Function : up_deinit_ribu
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1250 +------------------------------------------------------------------------------
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1251 \| Description :
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1252 \|
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1253 \| Parameters : -
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1254 \|
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1255 \|
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1256 \| Return : -
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1257 +------------------------------------------------------------------------------
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1258 */
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1259
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1260 GLOBAL void up_deinit_ribu(void)
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1261 {
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1262 T_UP *dup = &l2r_data->up;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1263
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1264 T_PRIM_DESC_RIBU_INDEX n;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1265
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1266 T_P_UPRIM_DESCRIPTOR primDesc;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1267
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1268 TRACE_FUNCTION ("up_deinit_ribu()");
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1269
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1270 for (n = 0; n < dup->RiBu.idx.depth; n++)
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1271 {
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1272 primDesc = dup->RiBu.primDesc[n];
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1273 if (primDesc->prim NEQ NULL)
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1274 {
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1275 up_free_prim(primDesc);
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1276 }
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1277 }
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1278 if (GET_STATE (UP_LL) EQ ISW_SEND)
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1279 {
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1280 SET_STATE (UP_LL, ISW_IDLE);
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1281 }
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1282 }
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1283
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1284 /*
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1285 +------------------------------------------------------------------------------
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1286 \| Function : up_send_status
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1287 +------------------------------------------------------------------------------
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1288 \| Description :
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1289 \|
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1290 \| Parameters : sa -
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1291 \| sb -
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1292 \| flow -
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1293 \| adr -
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1294 \|
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1295 \| Return : -
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1296 +------------------------------------------------------------------------------
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1297 */
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1298
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1299
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1300
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1301 GLOBAL void up_send_status
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1302 (
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1303 T_BIT sa,
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1304 T_BIT sb,
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1305 T_FLOW flow,
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1306 UBYTE adr
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1307 )
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1308 {
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1309 T_UP *dup = &l2r_data->up;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1310
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1311 T_P_UPRIM_DESCRIPTOR primDesc;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1312 T_P_L2R_FRAME frame;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1313 T_BIT x = 0;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1314
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1315 TRACE_FUNCTION ("up_send_status()");
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1316
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1317 primDesc = dup->RiBu.primDesc[dup->RiBu.idx.wi];
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1318 frame = (*primDesc->adr)[0];
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1319
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1320 switch (flow)
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1321 {
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1322 case FL_ACTIVE:
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1323 x = 1;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1324 break;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1325 case FL_INACTIVE:
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1326 x = 0;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1327 break;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1328 }
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1329 (*frame)[0] = sa << SO_SA_BIT \| sb << SO_SB_BIT \| x << SO_X_BIT \| adr;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1330
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1331 /* jk:030501 - TEST CASE 251 -
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1332 new funktion parameter 'adr' was introduced
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1333 in order to cancel the older function 'up_send_break(...)'
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1334 */
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1335 primDesc->sa = sa; /* the status has to be saved in order to be correctly stored later */
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1336 primDesc->sb = sb; /* on into "dup->LastSentSa/Sb" [up_send current_prim()] */
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1337
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1338 primDesc->index = 1;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1339 primDesc->offset = 0;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1340
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1341 cl_ribu_write_index(&dup->RiBu.idx); /* point to next primitive */
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1342 }
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1343
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1344 /*
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1345 +------------------------------------------------------------------------------
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1346 \| Function : up_set_flow_in_prim
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1347 +------------------------------------------------------------------------------
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1348 \| Description :
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1349 \|
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1350 \| Parameters : prim -
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1351 \|
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1352 \|
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1353 \| Return : -
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1354 +------------------------------------------------------------------------------
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1355 */
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1356
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1357 LOCAL void up_set_flow_in_prim(T_P_RLP_DATA_REQ prim)
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1358 {
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1359 T_UP *dup = &l2r_data->up;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1360
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1361 if (dup->MrgFlow EQ FL_INACTIVE)
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1362 {
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1363 TRACE_FUNCTION ("up_set_flow_in_prim(INACTIVE)");
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1364 }
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1365 else
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1366 {
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1367 T_PRIM_INDEX frames;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1368 T_PRIM_INDEX ind;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1369 UBYTE off;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1370 register UBYTE statOct;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1371 T_P_L2R_FRAME frame;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1372
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1373 TRACE_FUNCTION ("up_set_flow_in_prim(ACTIVE)");
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1374
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1375 frames = prim->sdu.l_buf / (8 * dup->FrameSize);
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1376 frame = (T_P_L2R_FRAME) (prim->sdu.buf + (prim->sdu.o_buf / 8) + HEADER_LEN);
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1377 off = 0;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1378 ind = 0;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1379
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1380 while (ind < frames)
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1381 {
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1382 statOct = (*frame)[off];
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1383 SET_BIT(statOct, SO_X_BIT);
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1384 (*frame)[off] = statOct;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1385
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1386 switch (statOct & SO_ADR_MASK)
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1387 {
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1388 case SO_BREAK_REQ:
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1389 case SO_BREAK_ACK:
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1390 case SO_END_EMPTY:
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1391 case SO_END_FULL:
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1392 ind++;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1393 frame = (T_P_L2R_FRAME)((UBYTE*)frame + dup->FrameSize);
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1394 off = 0;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1395 break;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1396
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1397 case SO_TWO_OCTET:
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1398 off++;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1399 off += ((*frame)[off] & SO_ADR_MASK_TWO_OCT) + 1;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1400 if (off >= dup->DataSize)
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1401 {
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1402 ind++;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1403 frame = (T_P_L2R_FRAME)((UBYTE*)frame + dup->FrameSize);
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1404 off = 0;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1405 }
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1406 break;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1407
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1408 default:
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1409 off += (statOct & SO_ADR_MASK) + 1;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1410 if (off >= dup->DataSize)
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1411 {
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1412 ind++;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1413 frame = (T_P_L2R_FRAME)((UBYTE*)frame + dup->FrameSize);
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1414 off = 0;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1415 }
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1416 break;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1417 }
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1418 }
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1419 }
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1420 dup->LastSentFlow = dup->MrgFlow;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1421 }
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1422
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1423 /*
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1424 +------------------------------------------------------------------------------
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1425 \| Function : up_send_current_prim
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1426 +------------------------------------------------------------------------------
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1427 \| Description :
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1428 \|
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1429 \| Parameters : -
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1430 \|
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1431 \|
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1432 \| Return : -
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1433 +------------------------------------------------------------------------------
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1434 */
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1435
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1436 GLOBAL void up_send_current_prim(void)
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1437 {
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1438 T_UP *dup = &l2r_data->up;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1439 T_P_UPRIM_DESCRIPTOR primDesc = dup->RiBu.primDesc[dup->RiBu.idx.ri];
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1440
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1441 TRACE_FUNCTION ("up_send_current_prim()");
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1442
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1443 if (!primDesc->full AND primDesc->index < primDesc->nFr)
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1444 {
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1445 TRACE_FUNCTION ("prim is not full");
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1446 if (primDesc->offset > 0)
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1447 {
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1448 if (up_fill_in_status_octet((T_P_UBYTE)(*primDesc->adr)[primDesc->index], primDesc->off_status, primDesc->offset))
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1449 {
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1450 primDesc->offset++;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1451 if (primDesc->offset >= dup->DataSize)
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1452 {
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1453 primDesc->offset = 0;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1454 primDesc->index++;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1455 }
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1456 }
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1457 }
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1458
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1459 if (primDesc->offset > 0 OR primDesc->index EQ 0)
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1460 {
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1461 /*
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1462 * Add status octet, if there is a partly filled frame
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1463 * or if status has changed since last write
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1464 */
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1465 ((primDesc->adr)[primDesc->index])[primDesc->offset] =
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1466 dup->LastRcvdSa << SO_SA_BIT \|
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1467 dup->LastRcvdSb << SO_SB_BIT \|
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1468 0 << SO_X_BIT \|
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1469 SO_END_EMPTY;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1470 primDesc->sa = dup->LastRcvdSa;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1471 primDesc->sb = dup->LastRcvdSb;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1472 primDesc->index++;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1473 }
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1474 primDesc->prim->sdu.l_buf = primDesc->index * dup->FrameSize * 8;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1475 }
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1476
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1477 dup->LastSentSa = primDesc->sa;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1478 dup->LastSentSb = primDesc->sb;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1479 up_set_flow_in_prim(primDesc->prim);
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1480
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1481 PSENDX (RLP, primDesc->prim);
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1482
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1483 clear_primDesc(primDesc); /* this primitive doesn't belong to us any longer */
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1484
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1485 cl_ribu_read_index(&dup->RiBu.idx); /* point to next primitive */
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1486
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1487 dup->UrgentMsg = FALSE;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1488 up_check_alloc();
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1489 up_check_flow();
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1490 }
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1491
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1492
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1493 /*
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1494 +------------------------------------------------------------------------------
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1495 \| Function : up_send_prim_cond
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1496 +------------------------------------------------------------------------------
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1497 \| Description :
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1498 \|
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1499 \| Parameters : -
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1500 \|
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1501 \|
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1502 \| Return : -
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1503 +------------------------------------------------------------------------------
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1504 */
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1505
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1506 GLOBAL void up_send_prim_cond(void)
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1507 {
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1508 TRACE_FUNCTION ("up_send_prim_cond()");
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1509
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1510 switch (GET_STATE (UP_LL))
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1511 {
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1512 case ISW_WAIT:
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1513 TIMERSTOP (TIMER_TUP_SND);
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1514 up_send_current_prim();
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1515 SET_STATE (UP_LL, ISW_IDLE);
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1516 break;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1517
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1518 default:
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1519 l2r_data->up.UrgentMsg = TRUE;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1520 up_check_flow();
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1521 up_check_alloc();
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1522 SET_STATE (UP_LL, ISW_SEND);
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1523 break;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1524 }
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1525 }
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1526
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1527 /*
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1528 +------------------------------------------------------------------------------
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1529 \| Function : up_init_ribu
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1530 +------------------------------------------------------------------------------
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1531 \| Description :
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1532 \|
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1533 \| Parameters : -
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1534 \|
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1535 \|
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1536 \| Return : -
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1537 +------------------------------------------------------------------------------
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1538 */
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1539
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1540
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1541 GLOBAL void up_init_ribu(void)
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1542 {
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1543 T_UP *dup = &l2r_data->up;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1544
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1545 T_PRIM_DESC_RIBU_INDEX n;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1546 T_PRIM_INDEX m;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1547
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1548 TRACE_FUNCTION ("up_init_ribu()");
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1549
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1550 dup->RiBu.alloc = 0;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1551
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1552 cl_ribu_init(&dup->RiBu.idx, dup->RiBu.idx.depth);
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1553
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1554 for (n = 0; n < dup->RiBu.idx.depth; n++)
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1555 {
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1556 dup->RiBu.primDesc[n] = &(dup->PrimDesc[n]);
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1557
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1558 dup->PrimDesc[n].nFr = 0;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1559 dup->PrimDesc[n].adr = (T_P_ADR_VECTOR)&(dup->AdrVec[n]);
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1560 dup->PrimDesc[n].index = 0;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1561 dup->PrimDesc[n].offset = 0;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1562 dup->PrimDesc[n].off_status = 0;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1563 dup->PrimDesc[n].full = FALSE;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1564 dup->PrimDesc[n].sa = FL_INACTIVE;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1565 dup->PrimDesc[n].sb = FL_INACTIVE;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1566 dup->PrimDesc[n].prim = NULL;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1567
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1568 for(m = 0;m < L2R_FRAMES_PER_PRIM_MAX; m++)
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1569 {
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1570 dup->AdrVec[n][m] = NULL;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1571 }
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1572
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1573 if (dup->RiBu.alloc < UP_RIBU_PREALLOC)
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1574 {
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1575 up_alloc_prim();
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1576 }
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1577 }
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1578 }
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1579
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1580 /*
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1581 +------------------------------------------------------------------------------
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1582 \| Function : up_store_status
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1583 +------------------------------------------------------------------------------
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1584 \| Description :
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1585 \|
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1586 \| Parameters : sa
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1587 \| sb
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1588 \| flow
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1589 \|
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1590 \| Return : -
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1591 +------------------------------------------------------------------------------
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1592 */
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1593
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1594
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1595 GLOBAL void up_store_status
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1596 (
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1597 T_BIT sa,
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1598 T_BIT sb,
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1599 T_FLOW flow
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1600 )
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1601 {
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1602 T_UP *dup = &l2r_data->up;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1603
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1604 #ifdef _SIMULATION_
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1605 TRACE_FUNCTION ("up_store_status()");
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1606 #endif
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1607
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1608 dup->LastRcvdSa = sa;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1609 dup->LastRcvdSb = sb;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1610
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1611 if (dup->FlowCtrlUsed EQ FALSE OR flow EQ dup->ULFlow)
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1612 {
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1613 return;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1614 }
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1615
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1616 dup->ULFlow = flow;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1617
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1618 up_merge_flow();
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1619 sig_up_dn_ul_flow(dup->ULFlow);
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1620 }
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1621
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1622 /*
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1623 +------------------------------------------------------------------------------
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1624 \| Function : up_send_empty_frame
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1625 +------------------------------------------------------------------------------
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1626 \| Description :
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1627 \|
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1628 \| Parameters : sa -
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1629 \| sb -
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1630 \| flow -
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1631 \|
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1632 \| Return : -
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1633 +------------------------------------------------------------------------------
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1634 */
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1635
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1636
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1637 GLOBAL void up_send_empty_frame(T_BIT sa, T_BIT sb, T_FLOW flow)
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1638 {
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1639 T_UP *dup = &l2r_data->up;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1640
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1641 T_BIT x = 0;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1642 USHORT sduSize = dup->FrameSize << 3;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1643
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1644 PALLOC_SDU(data_req, RLP_DATA_REQ, sduSize);
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1645
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1646 TRACE_FUNCTION ("up_send_empty_frame()");
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1647
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1648 #ifdef _SIMULATION_
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1649 /* Clear SDU for test environment */
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1650 {
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1651 UBYTE *p;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1652 UBYTE *pend;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1653 p = &data_req->sdu.buf[0];
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1654 pend = p + dup->FrameSize;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1655 while (p < pend)
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1656 {
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1657 *p++ = 0;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1658 }
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1659 }
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1660 #endif
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1661
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1662 data_req->sdu.o_buf = 0;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1663 data_req->sdu.l_buf = sduSize;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1664
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1665 switch (flow)
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1666 {
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1667 case FL_ACTIVE:
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1668 x = 1;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1669 break;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1670 case FL_INACTIVE:
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1671 x = 0;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1672 break;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1673 }
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1674 /lint -e416 (Warning -- Likely creation of out-of-bounds pointer) /
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1675 /lint -e415 (Warning -- Likely access of out-of-bounds pointer) /
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1676 data_req->sdu.buf[L2R_ENCODING_OFFSET] = sa << SO_SA_BIT \| sb << SO_SB_BIT \| x << SO_X_BIT \| SO_END_EMPTY;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1677 /lint +e416 (Warning -- Likely creation of out-of-bounds pointer) /
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1678 /lint +e415 (Warning -- Likely access of out-of-bounds pointer) /
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1679
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1680 dup->LastSentFlow = flow;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1681 dup->LastSentSa = sa;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1682 dup->LastSentSb = sb;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1683
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1684 PSENDX (RLP, data_req);
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1685 }
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1686
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1687 /*
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1688 +------------------------------------------------------------------------------
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1689 \| Function : up_merge_flow
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1690 +------------------------------------------------------------------------------
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1691 \| Description :
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1692 \|
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1693 \| Parameters : -
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1694 \|
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1695 \|
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1696 \| Return : -
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1697 +------------------------------------------------------------------------------
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1698 */
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1699
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1700
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1701 GLOBAL void up_merge_flow(void)
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1702 {
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1703 T_UP *dup = &l2r_data->up;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1704
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1705 #ifdef _SIMULATION_
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1706 TRACE_FUNCTION ("up_merge_flow()");
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1707 #endif
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1708
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1709 if (dup->FlowCtrlUsed AND (dup->DnFlow EQ FL_ACTIVE OR dup->ULFlow EQ FL_ACTIVE))
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1710 {
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1711 /* flow control active */
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1712 dup->MrgFlow = FL_ACTIVE;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1713 }
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1714 else
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1715 {
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1716 /* flow control inactive */
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1717 dup->MrgFlow = FL_INACTIVE;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1718 }
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1719
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1720 }
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1721
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1722 /*
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1723 +------------------------------------------------------------------------------
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1724 \| Function : up_rq_init
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1725 +------------------------------------------------------------------------------
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1726 \| Description :
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1727 \|
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1728 \| Parameters : -
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1729 \|
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1730 \|
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1731 \| Return : -
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1732 +------------------------------------------------------------------------------
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1733 */
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1734
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1735 GLOBAL void up_rq_init(void)
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1736 {
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1737 #ifdef _SIMULATION_
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1738 TRACE_FUNCTION ("up_rq_init()");
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1739 #endif
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1740
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1741 l2r_data->up.QRemapWrite = 0;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1742 l2r_data->up.QRemapRead = 0;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1743 }
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1744
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1745 /*
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1746 +------------------------------------------------------------------------------
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1747 \| Function : up_some_data_to_send
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1748 +------------------------------------------------------------------------------
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1749 \| Description :
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1750 \|
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1751 \| Parameters : -
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1752 \|
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1753 \|
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1754 \| Return : TRUE -
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1755 \| FALSE -
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1756 +------------------------------------------------------------------------------
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1757 */
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1758
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1759 GLOBAL BOOL up_some_data_to_send(void)
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1760 {
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1761 T_UP *dup = &l2r_data->up;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1762
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1763 #ifdef _SIMULATION_
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1764 TRACE_EVENT ("check if any data to send");
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1765 #endif
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1766
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1767 if (
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1768 dup->RiBu.idx.filled OR
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1769 (dup->RiBu.primDesc[dup->RiBu.idx.ri]->index > 0) OR
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1770 (dup->RiBu.primDesc[dup->RiBu.idx.ri]->offset > 0) OR
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1771 (dup->LastRcvdSa NEQ dup->LastSentSa) OR
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1772 (dup->LastRcvdSb NEQ dup->LastSentSb)
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1773 )
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1774 {
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1775 return (TRUE);
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1776 }
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1777 return (FALSE);
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1778 }

FreeCalypso > hg > fc-tourmaline

annotate src/g23m-fad/l2r/l2r_upf.c @ 19:aa868a5dcfd7