fc-magnetite: src/g23m-fad/fad/fad

annotate src/g23m-fad/fad/fad_sndf.c @ 702:9394305d4ff5 default tip

etm_audio.c: fix off-by-one error in auw of FIR coefficients This fix was already made in FC Tourmaline a while back, but it is also the kind of bugfix that deserves to be backported to Magnetite and Selenite as well.

author	Mychaela Falconia <falcon@freecalypso.org>
date	Mon, 31 Oct 2022 00:14:44 +0000
parents	90eb61ecd093
children

rev	line source
174 90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1 /*
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2 +-----------------------------------------------------------------------------
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	3 \| Project : GSM-F&D (8411)
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	4 \| Modul : FAD_SNDF
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	5 +-----------------------------------------------------------------------------
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	6 \| Copyright 2002 Texas Instruments Berlin, AG
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	7 \| All rights reserved.
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	8 \|
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	9 \| This file is confidential and a trade secret of Texas
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	10 \| Instruments Berlin, AG
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	11 \| The receipt of or possession of this file does not convey
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	12 \| any rights to reproduce or disclose its contents or to
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	13 \| manufacture, use, or sell anything it may describe, in
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	14 \| whole, or in part, without the specific written consent of
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	15 \| Texas Instruments Berlin, AG.
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	16 +-----------------------------------------------------------------------------
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	17 \| Purpose : This Modul defines the procedures and functions for
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	18 \| the SND subcomponent SEQ (sequencer)
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	19 +-----------------------------------------------------------------------------
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	20 */
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	21
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	22 #ifndef FAD_SNDF_C
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	23 #define FAD_SNDF_C
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	24 #endif
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	25
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	26 #define ENTITY_FAD
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	27
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	28 /==== INCLUDES ===================================================/
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	29
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	30 #include <string.h>
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	31 #include "typedefs.h"
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	32 #include "vsi.h"
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	33 #include "macdef.h"
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	34 #include "pconst.cdg"
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	35 #include "custom.h"
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	36 #include "gsm.h"
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	37 #include "cnf_fad.h"
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	38 #include "mon_fad.h"
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	39 #include "prim.h"
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	40 #include "pei.h"
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	41 #include "tok.h"
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	42 #include "ccdapi.h"
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	43 #include "fad.h"
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	44 #include "ra_l1int.h"
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	45
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	46 /==== CONST =======================================================/
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	47
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	48 /==== TYPES =======================================================/
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	49
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	50 /==== VAR EXPORT ==================================================/
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	51
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	52 /==== VAR LOCAL ===================================================/
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	53
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	54 /==== FUNCTIONS ===================================================/
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	55
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	56 /*
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	57 +--------------------------------------------------------------------+
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	58 \| PROJECT : GSM-F&D (8411) MODULE : FAD_SNDF \|
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	59 \| STATE : code ROUTINE : snd_init \|
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	60 +--------------------------------------------------------------------+
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	61
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	62 PURPOSE : initialise the sequencer
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	63
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	64 */
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	65
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	66 GLOBAL void snd_init (void)
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	67 {
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	68 T_SND *snd = &fad_data->snd;
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	69 T_SBM *sbm = &fad_data->sbm;
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	70
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	71 TRACE_FUNCTION ("snd_init()");
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	72
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	73 snd->bytes_to_send = REPEAT_FOREVER;
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	74 snd->ra_req_frames = 0;
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	75 snd->reset = SYNC_RESET;
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	76 snd->send_ready_to_t30 = FALSE;
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	77 snd->seq_buflen = 0;
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	78 snd->seq_bufpos = 0;
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	79 snd->data_bufpos = 0;
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	80 snd->fad_data_req = NULL;
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	81
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	82 sbm->FrameSize = FRAME_SIZE;
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	83 sbm->syncCycle = SYNC_CYCLE_NONE;
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	84 sbm->framesUntilSync = 0;
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	85
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	86 snd_SetSequence (snd->seq_buf, &snd->seq_buflen, (UBYTE*)FR_SEQ_SYNC, LEN_SEQ_SYNC, 3);
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	87 }
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	88
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	89
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	90 /*
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	91 +--------------------------------------------------------------------+
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	92 \| PROJECT : GSM-F&D (8411) MODULE : FAD_SNDF \|
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	93 \| STATE : code ROUTINE : snd_setupTCF \|
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	94 +--------------------------------------------------------------------+
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	95
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	96 PURPOSE : initialise the sequencer for TCF
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	97
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	98 */
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	99
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	100 LOCAL void snd_setupTCF (void)
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	101 {
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	102 T_SND *snd = &fad_data->snd;
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	103
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	104 snd->seq_buflen = 0;
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	105
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	106 switch (snd->trans_rate)
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	107 {
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	108 case R_12000: /* 5 Data frames + 1 SYNC frame */
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	109 snd_SetSequence(snd->seq_buf, &snd->seq_buflen, (UBYTE*)FR_SEQ_TCF, LEN_SEQ_TCF, 5);
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	110 snd_SetSequence(&snd->seq_buf [snd->seq_buflen], &snd->seq_buflen, (UBYTE*)FR_SEQ_SYNC, LEN_SEQ_SYNC, 1);
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	111 TRACE_EVENT ("setup TCF 12kbps");
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	112 break;
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	113
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	114 case R_7200: /* 3 Data frames + 1 SYNC frame */
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	115 snd_SetSequence(snd->seq_buf, &snd->seq_buflen, (UBYTE*)FR_SEQ_TCF, LEN_SEQ_TCF, 3);
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	116 snd_SetSequence(&snd->seq_buf [snd->seq_buflen], &snd->seq_buflen, (UBYTE*)FR_SEQ_SYNC, LEN_SEQ_SYNC, 1);
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	117 TRACE_EVENT ("setup TCF 7.2kbps");
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	118 break;
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	119
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	120 case R_14400: /* 5 Data frames */
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	121 case R_9600:
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	122 case R_4800:
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	123 case R_2400:
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	124 default:
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	125 snd_SetSequence (snd->seq_buf, &snd->seq_buflen, (UBYTE *)FR_SEQ_TCF, LEN_SEQ_TCF, 5);
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	126 TRACE_EVENT ("setup norm TCF");
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	127 break;
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	128 }
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	129 }
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	130
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	131 /*
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	132 +-------------------------------------------------------------------------+
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	133 \| PROJECT : GSM-F&D (8411) MODULE : FAD_SNDS \|
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	134 \| STATE : code ROUTINE : snd_SendReset \|
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	135 +-------------------------------------------------------------------------+
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	136
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	137 PURPOSE : Send SYNC frames following return to IDLE state
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	138
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	139 */
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	140
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	141 GLOBAL void snd_SendReset (USHORT bytes_to_send)
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	142 {
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	143 T_SND *snd = &fad_data->snd;
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	144
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	145 TRACE_FUNCTION ("snd_SendReset()");
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	146
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	147 if (snd->reset)
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	148 {
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	149 snd->reset--;
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	150 snd_SendSequence (bytes_to_send, FR_SYNC);
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	151 }
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	152
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	153 if (!snd->reset)
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	154 {
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	155 snd->seq_buflen = 0;
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	156 snd->seq_bufpos = 0;
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	157
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	158 switch (GET_STATE (SND))
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	159 {
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	160 case PREAM_SND:
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	161 snd->bytes_to_send = PREAMBLE_BYTES_TI_SND;
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	162 snd_SetSequence (snd->seq_buf, &snd->seq_buflen, (UBYTE*)FR_SEQ_PREAMBLE, LEN_SEQ_PREAMBLE, 12);
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	163 break;
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	164
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	165 case TCF_SND:
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	166 snd->bytes_to_send = snd_DurationToBytes (snd->trans_rate, TIME_TCF_SND);
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	167 snd_setupTCF(); /* set the sequencer for the TCF pattern */
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	168 break;
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	169
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	170 case TRAIN_SND:
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	171 #ifdef _SIMULATION_
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	172 snd_SetSequence (snd->seq_buf, &snd->seq_buflen, (UBYTE*)FR_SEQ_TRAIN_SND, LEN_SEQ_TRAIN, 4);
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	173 snd_SetSequence (&snd->seq_buf [snd->seq_buflen], &snd->seq_buflen, (UBYTE*)FR_SEQ_SYNC, LEN_SEQ_SYNC, 1);
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	174 #else /* TI: only 2 bytes set - no SYNCs */
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	175 snd_SetSequence (snd->seq_buf, &snd->seq_buflen, (UBYTE*)FR_SEQ_TRAIN_SND, LEN_SEQ_TRAIN, 1);
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	176 #endif
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	177 break;
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	178
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	179 case TRAIN_CNF_SND:
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	180 #ifdef _SIMULATION_
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	181 snd_SetSequence (snd->seq_buf, &snd->seq_buflen, (UBYTE*)FR_SEQ_TRAIN_RCV, LEN_SEQ_TRAIN, 4);
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	182 snd_SetSequence (&snd->seq_buf [snd->seq_buflen], &snd->seq_buflen, (UBYTE*)FR_SEQ_SYNC, LEN_SEQ_SYNC, 1);
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	183 #else /* TI: only 2 bytes set - no SYNCs */
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	184 snd_SetSequence (snd->seq_buf, &snd->seq_buflen, (UBYTE*)FR_SEQ_TRAIN_RCV, LEN_SEQ_TRAIN, 1);
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	185 #endif
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	186 break;
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	187 }
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	188 }
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	189 }
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	190
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	191
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	192 /*
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	193 +--------------------------------------------------------------------+
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	194 \| PROJECT : GSM-F&D (8411) MODULE : FAD_SNDF \|
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	195 \| STATE : code ROUTINE : snd_SetSequence \|
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	196 +--------------------------------------------------------------------+
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	197
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	198 PURPOSE : set frame
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	199
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	200 */
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	201
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	202 GLOBAL void snd_SetSequence (UBYTE seq_buf, USHORT seq_buflen,
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	203 UBYTE *sequence, USHORT seq_len, USHORT repeat)
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	204 {
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	205 TRACE_FUNCTION ("snd_SetSequence()");
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	206
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	207 seq_buflen += (seq_len repeat);
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	208
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	209 while (repeat--)
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	210 {
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	211 memcpy (seq_buf, sequence, seq_len);
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	212 seq_buf += seq_len;
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	213 }
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	214 }
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	215
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	216 #if defined TRACE_FAD_UL_STATUS \|\| defined _SIMULATION_
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	217
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	218 LOCAL void trace_fad_ul_frame_type(USHORT cus_frame_type, UBYTE* buf1, USHORT bytes_to_write)
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	219 {
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	220 const char type[5] = "DSYT";
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	221 char buf[15] = "TISx:0x00-0x00";
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	222
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	223 if (cus_frame_type < 4)
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	224 buf[3] = type[cus_frame_type];
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	225
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	226 if (buf1)
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	227 BYTE2HEXSTR(*(buf1+1), &buf[7]);
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	228
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	229 BYTE2HEXSTR((UBYTE)bytes_to_write, &buf[12]);
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	230 TRACE_EVENT (buf);
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	231 }
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	232
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	233 #endif
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	234
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	235 /*
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	236 +--------------------------------------------------------------------+
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	237 \| PROJECT : GSM-F&D (8411) MODULE : FAD_SNDF \|
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	238 \| STATE : code ROUTINE : snd_ra_data_req \|
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	239 +--------------------------------------------------------------------+
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	240
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	241 PURPOSE : Converts contents of frame descriptor to primitive
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	242
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	243 */
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	244 LOCAL void snd_ra_data_req(T_FD *pFD)
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	245 {
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	246
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	247 #if defined TRACE_FAD_UL_STATUS \|\| defined _SIMULATION_
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	248
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	249 if (pFD->type EQ FR_STATUS)
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	250 {
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	251 trace_fad_ul_frame_type(FR_STATUS, pFD->buf, pFD->len);
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	252 }
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	253 /*
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	254 void t30_ker_debug(CHAR header, UBYTE buf, USHORT len);
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	255
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	256 if (pFD->type EQ FR_STATUS)
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	257 {
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	258 t30_ker_debug("BCS-RCV", pFD->buf, pFD->len);
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	259 }
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	260 */
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	261 #endif
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	262
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	263 #ifdef _SIMULATION_
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	264 {
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	265 PALLOC_SDU (ra_data_req, RA_DATA_REQ, (USHORT)(pFD->len<<3));
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	266
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	267 TRACE_FUNCTION ("snd_ra_data_req()");
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	268
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	269 ra_data_req->sdu.l_buf = pFD->len<<3;
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	270 memcpy (&ra_data_req->sdu.buf, pFD->buf, pFD->len);
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	271 ra_data_req->fr_type = pFD->type;
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	272 ra_data_req->dtx_flg = DTX_DIS;
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	273 ra_data_req->status = ST_SA;
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	274 PSENDX (RA, ra_data_req);
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	275 }
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	276 #else
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	277
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	278 l1i_ra_data_req_new(pFD);
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	279
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	280 #endif
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	281 }
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	282
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	283
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	284 /*
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	285 +--------------------------------------------------------------------+
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	286 \| PROJECT : GSM-F&D (8411) MODULE : FAD_SNDF \|
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	287 \| STATE : code ROUTINE : snd_SendSequence \|
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	288 +--------------------------------------------------------------------+
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	289
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	290 PURPOSE :
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	291
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	292 */
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	293
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	294 GLOBAL USHORT snd_SendSequence (USHORT bytes_to_send, UBYTE fr_type)
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	295 {
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	296 T_SND *snd = &fad_data->snd;
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	297 USHORT sdu_buf_pos = 0;
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	298
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	299 #ifdef _SIMULATION_
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	300 TRACE_FUNCTION ("snd_SendSequence()");
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	301 #endif
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	302
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	303 #ifdef _TARGET_
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	304 switch (fr_type)
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	305 {
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	306 case FR_SYNC:
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	307 break;
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	308
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	309 case FR_STATUS:
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	310 case FR_TRAIN:
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	311 bytes_to_send = 2;
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	312 break;
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	313
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	314 default:
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	315 break;
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	316 }
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	317 #endif
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	318
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	319 if (snd->bytes_to_send NEQ REPEAT_FOREVER)
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	320 {
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	321 if (snd->bytes_to_send > bytes_to_send)
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	322 snd->bytes_to_send -= bytes_to_send;
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	323 else
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	324 snd->bytes_to_send = 0;
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	325 }
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	326
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	327 snd->FD.type = fr_type;
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	328 snd->FD.len = (U8)bytes_to_send;
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	329
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	330 while (bytes_to_send)
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	331 {
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	332 UBYTE bytes_to_read = MINIMUM(snd->seq_buflen - snd->seq_bufpos, bytes_to_send);
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	333
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	334 memcpy(&snd->FD.buf[sdu_buf_pos], &snd->seq_buf[snd->seq_bufpos], bytes_to_read);
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	335 sdu_buf_pos += bytes_to_read;
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	336 snd->seq_bufpos += bytes_to_read; /* reset pos. in sequence */
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	337
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	338 if (bytes_to_send > bytes_to_read)
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	339 bytes_to_send -= bytes_to_read;
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	340 else
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	341 bytes_to_send = 0;
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	342
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	343 if (snd->seq_bufpos >= snd->seq_buflen) /* check sequence boundary */
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	344 snd->seq_bufpos -= snd->seq_buflen;
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	345 }
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	346
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	347 snd_ra_data_req(&snd->FD);
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	348
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	349 return (snd->bytes_to_send);
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	350 }
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	351
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	352 /*
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	353 +--------------------------------------------------------------------+
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	354 \| PROJECT : GSM-F&D (8411) MODULE : FAD_SNDF \|
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	355 \| STATE : code ROUTINE : snd_DurationToBytes \|
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	356 +--------------------------------------------------------------------+
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	357
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	358 PURPOSE : convert duration of sequence to be sent to bytes, taking
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	359 account of the transmission rate set
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	360
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	361 */
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	362
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	363 GLOBAL USHORT snd_DurationToBytes (USHORT trans_rate, USHORT duration)
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	364 {
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	365
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	366 TRACE_FUNCTION ("snd_DurationToBytes()");
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	367
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	368 return (trans_rate * duration / (8 * 1000));
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	369
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	370 }
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	371
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	372 #ifdef _SIMULATION_
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	373 /*
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	374 +--------------------------------------------------------------------+
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	375 \| PROJECT : GSM-F&D (8411) MODULE : FAD_SNDF \|
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	376 \| STATE : code ROUTINE : SetBcsFrameBuffer \|
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	377 +--------------------------------------------------------------------+
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	378
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	379 PURPOSE : copy HDLC data for buffer sending - add BCS-REC ident & repeats
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	380
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	381 */
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	382
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	383 LOCAL void SetBcsFrameBuffer (UBYTE bcs_buf, UBYTE hdlc_buf, USHORT len, USHORT repeat)
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	384 {
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	385 USHORT i, j, k;
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	386
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	387 TRACE_FUNCTION ("SetBcsFrameBuffer()");
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	388
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	389 for (i = 0; i < len; hdlc_buf++)
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	390 {
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	391 for (j = 0; j < repeat; j++)
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	392 for (k = 0; k < HDLC_REPEAT; i++, k++, bcs_buf++)
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	393 if (i & 0x0001)
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	394 bcs_buf = hdlc_buf;
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	395 else
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	396 *bcs_buf = IDENT_BCS_REC;
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	397 }
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	398
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	399 }
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	400
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	401 #endif
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	402
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	403 /*
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	404 +-----------------------------------------------------------------------+
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	405 \| PROJECT : GSM-F&D (8411) MODULE : FAD_SNDF \|
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	406 \| STATE : code ROUTINE : snd_BuildStatusFrames \|
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	407 +-----------------------------------------------------------------------+
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	408
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	409 PURPOSE : build BCS frames from HDLC data received from T30
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	410 pass to SBM buffer
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	411
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	412 */
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	413
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	414 #ifdef _SIMULATION_
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	415 GLOBAL void snd_BuildStatusFrames(T_FAD_DATA_REQ *fad_data_req, USHORT max_bytes)
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	416 #else
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	417 GLOBAL void snd_BuildStatusFrames(T_FAD_DATA_REQ *fad_data_req)
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	418 #endif
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	419 {
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	420 T_SND *snd = &fad_data->snd;
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	421
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	422 #ifdef _SIMULATION_
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	423 USHORT repeat;
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	424
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	425 TRACE_FUNCTION ("snd_BuildStatusFrames()");
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	426
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	427 snd->final = fad_data_req->final;
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	428
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	429 /* set total bytes to be sent */
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	430
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	431 repeat = (USHORT)(snd->trans_rate / (BCS_RATE << 3));
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	432 snd->data_to_send = fad_data_req->sdu.l_buf * HDLC_REPEAT * repeat;
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	433
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	434 if (snd->data_to_send <= max_bytes)
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	435 fad_data_req->sdu.l_buf = 0;
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	436 else
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	437 {
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	438 snd->data_to_send = max_bytes;
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	439 fad_data_req->sdu.l_buf -= (snd->data_to_send / HDLC_REPEAT / repeat);
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	440 }
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	441
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	442 SetBcsFrameBuffer (&snd->seq_buf [0], &fad_data_req->sdu.buf [fad_data_req->sdu.o_buf], snd->data_to_send, repeat);
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	443
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	444 snd->data_bufpos = 0;
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	445 if (fad_data_req->sdu.l_buf)
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	446 fad_data_req->sdu.o_buf += (snd->data_to_send / HDLC_REPEAT / repeat);
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	447
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	448 #else /* _TARGET_ */
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	449
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	450 snd->data_to_send = fad_data_req->sdu.l_buf >> 3;
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	451 fad_data_req->sdu.l_buf = 0;
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	452 snd->data_bufpos = 0;
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	453
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	454 #endif
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	455 }
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	456
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	457 /*
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	458 +--------------------------------------------------------------------+
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	459 \| PROJECT : GSM-F&D (8411) MODULE : FAD_SNDF \|
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	460 \| STATE : code ROUTINE : snd_StoreMsgData \|
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	461 +--------------------------------------------------------------------+
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	462
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	463 PURPOSE : store MSG data and pass to SBM buffer
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	464
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	465 */
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	466
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	467 GLOBAL void snd_StoreMsgData (T_FAD_DATA_REQ *fad_data_req)
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	468 {
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	469 T_SND *snd = &fad_data->snd;
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	470
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	471 TRACE_FUNCTION ("snd_StoreMsgData()");
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	472
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	473 snd->final = fad_data_req->final;
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	474
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	475 if (fad_data_req->sdu.l_buf)
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	476 {
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	477 snd->data_bufpos += (fad_data_req->sdu.l_buf >> 3);
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	478 sbm_store_prim (fad_data_req); /* pass primitive to send buffer */
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	479 }
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	480 if (!snd->final)
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	481 {
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	482 if (snd->data_to_send < snd->threshold)
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	483 sig_snd_ker_ready_ind ();
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	484 else
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	485 snd->send_ready_to_t30 = TRUE;
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	486 }
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	487 }
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	488
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	489
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	490 /*
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	491 +--------------------------------------------------------------------+
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	492 \| PROJECT : GSM-F&D (8411) MODULE : FAD_SNDF \|
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	493 \| STATE : code ROUTINE : snd_SendMsgData \|
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	494 +--------------------------------------------------------------------+
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	495
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	496 PURPOSE :
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	497
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	498 */
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	499
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	500 GLOBAL BOOL snd_SendMsgData (UBYTE req_frames)
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	501 {
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	502 T_SND *snd = &fad_data->snd;
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	503 T_FRAME_DESC ul_FD;
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	504
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	505 #ifdef _SIMULATION_
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	506 TRACE_FUNCTION ("snd_SendMsgData()");
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	507 #endif
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	508
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	509 if (sbm_get_frame(&ul_FD, req_frames) EQ TRUE)
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	510 {
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	511 U8 sdu_len = (U8)(ul_FD.Len[0] + ul_FD.Len[1]);
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	512
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	513 snd->data_to_send -= sdu_len;
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	514 snd->FD.type = FR_T4DATA;
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	515 snd->FD.len = sdu_len;
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	516 memcpy(snd->FD.buf, ul_FD.Adr[0], ul_FD.Len[0]);
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	517 memcpy(&snd->FD.buf[ul_FD.Len[0]], ul_FD.Adr[1], ul_FD.Len[1]);
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	518 snd_ra_data_req(&snd->FD);
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	519 return TRUE;
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	520 }
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	521 else
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	522 {
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	523 return FALSE;
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	524 }
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	525 }
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	526
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	527 /*
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	528 +--------------------------------------------------------------------+
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	529 \| PROJECT : GSM-F&D (8411) MODULE : FAD_SNDF \|
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	530 \| STATE : code ROUTINE : snd_SendBcsData \|
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	531 +--------------------------------------------------------------------+
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	532
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	533 PURPOSE :
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	534
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	535 */
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	536 #ifdef _SIMULATION_
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	537 GLOBAL void snd_SendBcsData (USHORT bytes_to_send)
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	538 #else
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	539 GLOBAL void snd_SendBcsData (void)
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	540 #endif
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	541 {
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	542 T_SND *snd = &fad_data->snd;
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	543
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	544 TRACE_FUNCTION ("snd_SendBcsData()");
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	545
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	546 if (!snd->data_to_send)
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	547 return;
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	548
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	549 snd->FD.type = FR_STATUS;
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	550
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	551 #ifdef _SIMULATION_
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	552
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	553 if (snd->data_to_send >= bytes_to_send)
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	554 snd->data_to_send -= bytes_to_send;
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	555 else
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	556 {
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	557 bytes_to_send = snd->data_to_send;
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	558 snd->data_to_send = 0;
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	559 }
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	560 snd->FD.len = (U8)bytes_to_send;
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	561 memcpy(snd->FD.buf, &snd->seq_buf[snd->data_bufpos], snd->FD.len);
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	562 snd->data_bufpos += bytes_to_send;
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	563
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	564 #else /* _TARGET_ */
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	565 snd->FD.buf[0] = IDENT_BCS_REC;
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	566 snd->FD.buf[1] = snd->fad_data_req->sdu.buf[snd->data_bufpos++];
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	567 snd->FD.len = 2;
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	568 snd->data_to_send--;
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	569
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	570 #endif /* _TARGET_ */
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	571
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	572 snd_ra_data_req(&snd->FD);
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	573 }
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	574

FreeCalypso > hg > fc-magnetite

annotate src/g23m-fad/fad/fad_sndf.c @ 702:9394305d4ff5 default tip