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

annotate src/g23m-fad/l2r/l2r_upf.c @ 303:f76436d19a7a default tip

!GPRS config: fix long-standing AT+COPS chance hanging bug There has been a long-standing bug in FreeCalypso going back years: sometimes in the AT command bring-up sequence of an ACI-only MS, the AT+COPS command would produce only a power scan followed by cessation of protocol stack activity (only L1 ADC traces), instead of the expected network search sequence. This behaviour was seen in different FC firmware versions going back to Citrine, and seemed to follow some law of chance, not reliably repeatable. This bug has been tracked down and found to be specific to !GPRS configuration, stemming from our TCS2/TCS3 hybrid and reconstruction of !GPRS support that was bitrotten in TCS3.2/LoCosto version. ACI module psa_mms.c, needed only for !GPRS, was missing in the TCS3 version and had to be pulled from TCS2 - but as it turns out, there is a new field in the MMR_REG_REQ primitive that needs to be set correctly, and that psa_mms.c module is the place where this initialization needed to be added.

author	Mychaela Falconia <falcon@freecalypso.org>
date	Thu, 08 Jun 2023 08:23:37 +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 @ 303:f76436d19a7a default tip