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

annotate src/g23m-fad/fad/fad_sndf.c @ 217:6541e43f88e5

R2D display on/off control implemented

author	Mychaela Falconia <falcon@freecalypso.org>
date	Sat, 24 Apr 2021 23:38:18 +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 : GSM-F&D (8411)
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	4 \| Modul : FAD_SNDF
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 SND subcomponent SEQ (sequencer)
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 FAD_SNDF_C
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	23 #define FAD_SNDF_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_FAD
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 "vsi.h"
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	33 #include "macdef.h"
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	34 #include "pconst.cdg"
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 "cnf_fad.h"
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	38 #include "mon_fad.h"
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	39 #include "prim.h"
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	40 #include "pei.h"
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	41 #include "tok.h"
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	42 #include "ccdapi.h"
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	43 #include "fad.h"
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	44 #include "ra_l1int.h"
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	45
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	46 /==== CONST =======================================================/
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 /==== TYPES =======================================================/
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 /==== VAR EXPORT ==================================================/
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 LOCAL ===================================================/
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 /==== FUNCTIONS ===================================================/
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 /*
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 \| PROJECT : GSM-F&D (8411) MODULE : FAD_SNDF \|
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	59 \| STATE : code ROUTINE : snd_init \|
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	60 +--------------------------------------------------------------------+
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 PURPOSE : initialise the sequencer
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 */
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 GLOBAL void snd_init (void)
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	67 {
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	68 T_SND *snd = &fad_data->snd;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	69 T_SBM *sbm = &fad_data->sbm;
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 TRACE_FUNCTION ("snd_init()");
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 snd->bytes_to_send = REPEAT_FOREVER;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	74 snd->ra_req_frames = 0;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	75 snd->reset = SYNC_RESET;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	76 snd->send_ready_to_t30 = FALSE;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	77 snd->seq_buflen = 0;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	78 snd->seq_bufpos = 0;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	79 snd->data_bufpos = 0;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	80 snd->fad_data_req = NULL;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	81
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	82 sbm->FrameSize = FRAME_SIZE;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	83 sbm->syncCycle = SYNC_CYCLE_NONE;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	84 sbm->framesUntilSync = 0;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	85
fa8dc04885d8 src/g23m-: import from Magnetite 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);
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	87 }
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	88
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	89
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	90 /*
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	91 +--------------------------------------------------------------------+
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	92 \| PROJECT : GSM-F&D (8411) MODULE : FAD_SNDF \|
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	93 \| STATE : code ROUTINE : snd_setupTCF \|
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	94 +--------------------------------------------------------------------+
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	95
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	96 PURPOSE : initialise the sequencer for TCF
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	97
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	98 */
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	99
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	100 LOCAL void snd_setupTCF (void)
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	101 {
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	102 T_SND *snd = &fad_data->snd;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	103
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	104 snd->seq_buflen = 0;
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 switch (snd->trans_rate)
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 case R_12000: /* 5 Data frames + 1 SYNC frame */
fa8dc04885d8 src/g23m-: import from Magnetite 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);
fa8dc04885d8 src/g23m-: import from Magnetite 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);
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	111 TRACE_EVENT ("setup TCF 12kbps");
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	112 break;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	113
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	114 case R_7200: /* 3 Data frames + 1 SYNC frame */
fa8dc04885d8 src/g23m-: import from Magnetite 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);
fa8dc04885d8 src/g23m-: import from Magnetite 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);
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	117 TRACE_EVENT ("setup TCF 7.2kbps");
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	118 break;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	119
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	120 case R_14400: /* 5 Data frames */
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	121 case R_9600:
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	122 case R_4800:
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	123 case R_2400:
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	124 default:
fa8dc04885d8 src/g23m-: import from Magnetite 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);
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	126 TRACE_EVENT ("setup norm TCF");
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	127 break;
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 }
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 +-------------------------------------------------------------------------+
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	133 \| PROJECT : GSM-F&D (8411) MODULE : FAD_SNDS \|
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	134 \| STATE : code ROUTINE : snd_SendReset \|
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 PURPOSE : Send SYNC frames following return to IDLE state
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 */
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 GLOBAL void snd_SendReset (USHORT bytes_to_send)
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	142 {
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	143 T_SND *snd = &fad_data->snd;
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 ("snd_SendReset()");
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 if (snd->reset)
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	148 {
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	149 snd->reset--;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	150 snd_SendSequence (bytes_to_send, FR_SYNC);
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	151 }
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 if (!snd->reset)
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	154 {
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	155 snd->seq_buflen = 0;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	156 snd->seq_bufpos = 0;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	157
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	158 switch (GET_STATE (SND))
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	159 {
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	160 case PREAM_SND:
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	161 snd->bytes_to_send = PREAMBLE_BYTES_TI_SND;
fa8dc04885d8 src/g23m-: import from Magnetite 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);
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	163 break;
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 case TCF_SND:
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	166 snd->bytes_to_send = snd_DurationToBytes (snd->trans_rate, TIME_TCF_SND);
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	167 snd_setupTCF(); /* set the sequencer for the TCF pattern */
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	168 break;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	169
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	170 case TRAIN_SND:
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	171 #ifdef _SIMULATION_
fa8dc04885d8 src/g23m-: import from Magnetite 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);
fa8dc04885d8 src/g23m-: import from Magnetite 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);
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	174 #else /* TI: only 2 bytes set - no SYNCs */
fa8dc04885d8 src/g23m-: import from Magnetite 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);
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	176 #endif
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	177 break;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	178
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	179 case TRAIN_CNF_SND:
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	180 #ifdef _SIMULATION_
fa8dc04885d8 src/g23m-: import from Magnetite 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);
fa8dc04885d8 src/g23m-: import from Magnetite 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);
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	183 #else /* TI: only 2 bytes set - no SYNCs */
fa8dc04885d8 src/g23m-: import from Magnetite 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);
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	185 #endif
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	186 break;
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 /*
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 \| PROJECT : GSM-F&D (8411) MODULE : FAD_SNDF \|
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	195 \| STATE : code ROUTINE : snd_SetSequence \|
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	196 +--------------------------------------------------------------------+
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 PURPOSE : set frame
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	199
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 GLOBAL void snd_SetSequence (UBYTE seq_buf, USHORT seq_buflen,
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	203 UBYTE *sequence, USHORT seq_len, USHORT repeat)
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	204 {
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	205 TRACE_FUNCTION ("snd_SetSequence()");
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	206
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	207 seq_buflen += (seq_len repeat);
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	208
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	209 while (repeat--)
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	210 {
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	211 memcpy (seq_buf, sequence, seq_len);
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	212 seq_buf += seq_len;
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 }
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	215
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	216 #if defined TRACE_FAD_UL_STATUS \|\| defined _SIMULATION_
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 LOCAL void trace_fad_ul_frame_type(USHORT cus_frame_type, UBYTE* buf1, USHORT bytes_to_write)
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	219 {
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	220 const char type[5] = "DSYT";
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	221 char buf[15] = "TISx:0x00-0x00";
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 if (cus_frame_type < 4)
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	224 buf[3] = type[cus_frame_type];
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 if (buf1)
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	227 BYTE2HEXSTR(*(buf1+1), &buf[7]);
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	228
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	229 BYTE2HEXSTR((UBYTE)bytes_to_write, &buf[12]);
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	230 TRACE_EVENT (buf);
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	231 }
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	232
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	233 #endif
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	234
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 +--------------------------------------------------------------------+
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	237 \| PROJECT : GSM-F&D (8411) MODULE : FAD_SNDF \|
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	238 \| STATE : code ROUTINE : snd_ra_data_req \|
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 PURPOSE : Converts contents of frame descriptor to primitive
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 */
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	244 LOCAL void snd_ra_data_req(T_FD *pFD)
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	245 {
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	246
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	247 #if defined TRACE_FAD_UL_STATUS \|\| defined _SIMULATION_
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	248
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	249 if (pFD->type EQ FR_STATUS)
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 trace_fad_ul_frame_type(FR_STATUS, pFD->buf, pFD->len);
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 /*
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	254 void t30_ker_debug(CHAR header, UBYTE buf, USHORT len);
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 if (pFD->type EQ FR_STATUS)
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	257 {
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	258 t30_ker_debug("BCS-RCV", pFD->buf, pFD->len);
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 */
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	261 #endif
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	262
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	263 #ifdef _SIMULATION_
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	264 {
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	265 PALLOC_SDU (ra_data_req, RA_DATA_REQ, (USHORT)(pFD->len<<3));
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	266
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	267 TRACE_FUNCTION ("snd_ra_data_req()");
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 ra_data_req->sdu.l_buf = pFD->len<<3;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	270 memcpy (&ra_data_req->sdu.buf, pFD->buf, pFD->len);
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	271 ra_data_req->fr_type = pFD->type;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	272 ra_data_req->dtx_flg = DTX_DIS;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	273 ra_data_req->status = ST_SA;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	274 PSENDX (RA, ra_data_req);
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 #else
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 l1i_ra_data_req_new(pFD);
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	279
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	280 #endif
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
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	283
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	284 /*
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 \| PROJECT : GSM-F&D (8411) MODULE : FAD_SNDF \|
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	287 \| STATE : code ROUTINE : snd_SendSequence \|
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
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	290 PURPOSE :
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	291
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
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	294 GLOBAL USHORT snd_SendSequence (USHORT bytes_to_send, UBYTE fr_type)
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	295 {
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	296 T_SND *snd = &fad_data->snd;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	297 USHORT sdu_buf_pos = 0;
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 #ifdef _SIMULATION_
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	300 TRACE_FUNCTION ("snd_SendSequence()");
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	301 #endif
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 #ifdef _TARGET_
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	304 switch (fr_type)
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	305 {
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	306 case FR_SYNC:
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	307 break;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	308
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	309 case FR_STATUS:
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	310 case FR_TRAIN:
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	311 bytes_to_send = 2;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	312 break;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	313
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	314 default:
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	315 break;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	316 }
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	317 #endif
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 if (snd->bytes_to_send NEQ REPEAT_FOREVER)
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 if (snd->bytes_to_send > bytes_to_send)
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	322 snd->bytes_to_send -= bytes_to_send;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	323 else
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	324 snd->bytes_to_send = 0;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	325 }
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 snd->FD.type = fr_type;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	328 snd->FD.len = (U8)bytes_to_send;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	329
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	330 while (bytes_to_send)
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	331 {
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	332 UBYTE bytes_to_read = MINIMUM(snd->seq_buflen - snd->seq_bufpos, bytes_to_send);
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	333
fa8dc04885d8 src/g23m-: import from Magnetite 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);
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	335 sdu_buf_pos += bytes_to_read;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	336 snd->seq_bufpos += bytes_to_read; /* reset pos. in sequence */
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 if (bytes_to_send > bytes_to_read)
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	339 bytes_to_send -= bytes_to_read;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	340 else
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	341 bytes_to_send = 0;
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 if (snd->seq_bufpos >= snd->seq_buflen) /* check sequence boundary */
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	344 snd->seq_bufpos -= snd->seq_buflen;
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
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	347 snd_ra_data_req(&snd->FD);
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 return (snd->bytes_to_send);
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	350 }
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	351
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	352 /*
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	353 +--------------------------------------------------------------------+
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	354 \| PROJECT : GSM-F&D (8411) MODULE : FAD_SNDF \|
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	355 \| STATE : code ROUTINE : snd_DurationToBytes \|
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
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	358 PURPOSE : convert duration of sequence to be sent to bytes, taking
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	359 account of the transmission rate set
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 */
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	362
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	363 GLOBAL USHORT snd_DurationToBytes (USHORT trans_rate, USHORT duration)
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 TRACE_FUNCTION ("snd_DurationToBytes()");
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	367
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	368 return (trans_rate * duration / (8 * 1000));
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	369
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 #ifdef _SIMULATION_
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 +--------------------------------------------------------------------+
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	375 \| PROJECT : GSM-F&D (8411) MODULE : FAD_SNDF \|
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	376 \| STATE : code ROUTINE : SetBcsFrameBuffer \|
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
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	379 PURPOSE : copy HDLC data for buffer sending - add BCS-REC ident & repeats
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
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	383 LOCAL void SetBcsFrameBuffer (UBYTE bcs_buf, UBYTE hdlc_buf, USHORT len, USHORT repeat)
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 USHORT i, j, k;
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 TRACE_FUNCTION ("SetBcsFrameBuffer()");
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 for (i = 0; i < len; hdlc_buf++)
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	390 {
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	391 for (j = 0; j < repeat; j++)
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	392 for (k = 0; k < HDLC_REPEAT; i++, k++, bcs_buf++)
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	393 if (i & 0x0001)
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	394 bcs_buf = hdlc_buf;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	395 else
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	396 *bcs_buf = IDENT_BCS_REC;
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
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	399 }
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 #endif
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	402
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 \| PROJECT : GSM-F&D (8411) MODULE : FAD_SNDF \|
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	406 \| STATE : code ROUTINE : snd_BuildStatusFrames \|
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	407 +-----------------------------------------------------------------------+
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 PURPOSE : build BCS frames from HDLC data received from T30
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	410 pass to SBM buffer
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	411
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	412 */
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	413
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	414 #ifdef _SIMULATION_
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	415 GLOBAL void snd_BuildStatusFrames(T_FAD_DATA_REQ *fad_data_req, USHORT max_bytes)
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	416 #else
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	417 GLOBAL void snd_BuildStatusFrames(T_FAD_DATA_REQ *fad_data_req)
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	418 #endif
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	419 {
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	420 T_SND *snd = &fad_data->snd;
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 #ifdef _SIMULATION_
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	423 USHORT repeat;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	424
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	425 TRACE_FUNCTION ("snd_BuildStatusFrames()");
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 snd->final = fad_data_req->final;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	428
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	429 /* set total bytes to be sent */
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	430
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	431 repeat = (USHORT)(snd->trans_rate / (BCS_RATE << 3));
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	432 snd->data_to_send = fad_data_req->sdu.l_buf * HDLC_REPEAT * repeat;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	433
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	434 if (snd->data_to_send <= max_bytes)
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	435 fad_data_req->sdu.l_buf = 0;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	436 else
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	437 {
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	438 snd->data_to_send = max_bytes;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	439 fad_data_req->sdu.l_buf -= (snd->data_to_send / HDLC_REPEAT / repeat);
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	440 }
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 SetBcsFrameBuffer (&snd->seq_buf [0], &fad_data_req->sdu.buf [fad_data_req->sdu.o_buf], snd->data_to_send, repeat);
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 snd->data_bufpos = 0;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	445 if (fad_data_req->sdu.l_buf)
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	446 fad_data_req->sdu.o_buf += (snd->data_to_send / HDLC_REPEAT / repeat);
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	447
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	448 #else /* _TARGET_ */
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 snd->data_to_send = fad_data_req->sdu.l_buf >> 3;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	451 fad_data_req->sdu.l_buf = 0;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	452 snd->data_bufpos = 0;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	453
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	454 #endif
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	455 }
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 +--------------------------------------------------------------------+
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	459 \| PROJECT : GSM-F&D (8411) MODULE : FAD_SNDF \|
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	460 \| STATE : code ROUTINE : snd_StoreMsgData \|
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	461 +--------------------------------------------------------------------+
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 PURPOSE : store MSG data and pass to SBM buffer
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 */
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	466
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	467 GLOBAL void snd_StoreMsgData (T_FAD_DATA_REQ *fad_data_req)
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	468 {
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	469 T_SND *snd = &fad_data->snd;
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 TRACE_FUNCTION ("snd_StoreMsgData()");
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 snd->final = fad_data_req->final;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	474
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	475 if (fad_data_req->sdu.l_buf)
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	476 {
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	477 snd->data_bufpos += (fad_data_req->sdu.l_buf >> 3);
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	478 sbm_store_prim (fad_data_req); /* pass primitive to send buffer */
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 if (!snd->final)
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 if (snd->data_to_send < snd->threshold)
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	483 sig_snd_ker_ready_ind ();
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	484 else
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	485 snd->send_ready_to_t30 = TRUE;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	486 }
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
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	489
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	490 /*
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 \| PROJECT : GSM-F&D (8411) MODULE : FAD_SNDF \|
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	493 \| STATE : code ROUTINE : snd_SendMsgData \|
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	494 +--------------------------------------------------------------------+
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 PURPOSE :
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 */
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	499
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	500 GLOBAL BOOL snd_SendMsgData (UBYTE req_frames)
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	501 {
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	502 T_SND *snd = &fad_data->snd;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	503 T_FRAME_DESC ul_FD;
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 #ifdef _SIMULATION_
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	506 TRACE_FUNCTION ("snd_SendMsgData()");
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	507 #endif
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 if (sbm_get_frame(&ul_FD, req_frames) EQ TRUE)
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 U8 sdu_len = (U8)(ul_FD.Len[0] + ul_FD.Len[1]);
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	512
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	513 snd->data_to_send -= sdu_len;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	514 snd->FD.type = FR_T4DATA;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	515 snd->FD.len = sdu_len;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	516 memcpy(snd->FD.buf, ul_FD.Adr[0], ul_FD.Len[0]);
fa8dc04885d8 src/g23m-: import from Magnetite 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]);
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	518 snd_ra_data_req(&snd->FD);
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	519 return TRUE;
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 else
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 return FALSE;
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 }
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	526
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 +--------------------------------------------------------------------+
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	529 \| PROJECT : GSM-F&D (8411) MODULE : FAD_SNDF \|
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	530 \| STATE : code ROUTINE : snd_SendBcsData \|
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	531 +--------------------------------------------------------------------+
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 PURPOSE :
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	534
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 #ifdef _SIMULATION_
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	537 GLOBAL void snd_SendBcsData (USHORT bytes_to_send)
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	538 #else
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	539 GLOBAL void snd_SendBcsData (void)
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	540 #endif
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	541 {
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	542 T_SND *snd = &fad_data->snd;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	543
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	544 TRACE_FUNCTION ("snd_SendBcsData()");
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	545
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	546 if (!snd->data_to_send)
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	547 return;
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 snd->FD.type = FR_STATUS;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	550
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	551 #ifdef _SIMULATION_
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 if (snd->data_to_send >= bytes_to_send)
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	554 snd->data_to_send -= bytes_to_send;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	555 else
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	556 {
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	557 bytes_to_send = snd->data_to_send;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	558 snd->data_to_send = 0;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	559 }
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	560 snd->FD.len = (U8)bytes_to_send;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	561 memcpy(snd->FD.buf, &snd->seq_buf[snd->data_bufpos], snd->FD.len);
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	562 snd->data_bufpos += bytes_to_send;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	563
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	564 #else /* _TARGET_ */
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	565 snd->FD.buf[0] = IDENT_BCS_REC;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	566 snd->FD.buf[1] = snd->fad_data_req->sdu.buf[snd->data_bufpos++];
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	567 snd->FD.len = 2;
fa8dc04885d8 src/g23m-: import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	568 snd->data_to_send--;
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 #endif /* _TARGET_ */
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 snd_ra_data_req(&snd->FD);
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

FreeCalypso > hg > fc-tourmaline

annotate src/g23m-fad/fad/fad_sndf.c @ 217:6541e43f88e5