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

annotate src/g23m-fad/t30/t30_bcsf.c @ 597:f18b29e27be5

First attempt at MCSI voice path automatic switching The function is implemented at the ACI level in both aci2 and aci3, successfully avoids triggering the DSP bug on the first call, but the shutdown of MCSI upon call completion is not working properly yet in either version.

author	Mychaela Falconia <falcon@freecalypso.org>
date	Wed, 27 Mar 2019 22:18:35 +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 : t30_bcsf
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 component T30 of the mobile station
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 T30_BCSF_C
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	23 #define T30_BCSF_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_T30
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 <stdlib.h>
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	32 #include <stddef.h>
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	33 #include "typedefs.h"
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	34 #include "pcm.h"
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	35 #include "vsi.h"
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	36 #include "macdef.h"
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	37 #include "pconst.cdg"
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	38 #include "mconst.cdg"
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	39 #include "message.h"
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	40 #include "ccdapi.h"
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	41 #include "custom.h"
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	42 #include "gsm.h"
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	43 #include "prim.h"
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	44 #include "cnf_t30.h"
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	45 #include "mon_t30.h"
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	46 #include "pei.h"
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	47 #include "tok.h"
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	48 #include "dti.h" /* functionality of the dti library */
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	49 #include "t30.h"
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	50
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	51 /==== CONST =======================================================/
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	52
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	53 /==== TYPES =======================================================/
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	54
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	55 /==== VAR EXPORT ==================================================/
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 /==== VAR LOCAL ===================================================/
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	58
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	59
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	60 LOCAL const USHORT crctab[256] =
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 0x0000, 0x1021, 0x2042, 0x3063, 0x4084, 0x50A5, 0x60C6, 0x70E7,
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	63 0x8108, 0x9129, 0xA14A, 0xB16B, 0xC18C, 0xD1AD, 0xE1CE, 0xF1EF,
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	64 0x1231, 0x0210, 0x3273, 0x2252, 0x52B5, 0x4294, 0x72F7, 0x62D6,
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	65 0x9339, 0x8318, 0xB37B, 0xA35A, 0xD3BD, 0xC39C, 0xF3FF, 0xE3DE,
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	66 0x2462, 0x3443, 0x0420, 0x1401, 0x64E6, 0x74C7, 0x44A4, 0x5485,
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	67 0xA56A, 0xB54B, 0x8528, 0x9509, 0xE5EE, 0xF5CF, 0xC5AC, 0xD58D,
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	68 0x3653, 0x2672, 0x1611, 0x0630, 0x76D7, 0x66F6, 0x5695, 0x46B4,
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	69 0xB75B, 0xA77A, 0x9719, 0x8738, 0xF7DF, 0xE7FE, 0xD79D, 0xC7BC,
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	70 0x48C4, 0x58E5, 0x6886, 0x78A7, 0x0840, 0x1861, 0x2802, 0x3823,
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	71 0xC9CC, 0xD9ED, 0xE98E, 0xF9AF, 0x8948, 0x9969, 0xA90A, 0xB92B,
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	72 0x5AF5, 0x4AD4, 0x7AB7, 0x6A96, 0x1A71, 0x0A50, 0x3A33, 0x2A12,
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	73 0xDBFD, 0xCBDC, 0xFBBF, 0xEB9E, 0x9B79, 0x8B58, 0xBB3B, 0xAB1A,
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	74 0x6CA6, 0x7C87, 0x4CE4, 0x5CC5, 0x2C22, 0x3C03, 0x0C60, 0x1C41,
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	75 0xEDAE, 0xFD8F, 0xCDEC, 0xDDCD, 0xAD2A, 0xBD0B, 0x8D68, 0x9D49,
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	76 0x7E97, 0x6EB6, 0x5ED5, 0x4EF4, 0x3E13, 0x2E32, 0x1E51, 0x0E70,
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	77 0xFF9F, 0xEFBE, 0xDFDD, 0xCFFC, 0xBF1B, 0xAF3A, 0x9F59, 0x8F78,
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	78 0x9188, 0x81A9, 0xB1CA, 0xA1EB, 0xD10C, 0xC12D, 0xF14E, 0xE16F,
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	79 0x1080, 0x00A1, 0x30C2, 0x20E3, 0x5004, 0x4025, 0x7046, 0x6067,
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	80 0x83B9, 0x9398, 0xA3FB, 0xB3DA, 0xC33D, 0xD31C, 0xE37F, 0xF35E,
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	81 0x02B1, 0x1290, 0x22F3, 0x32D2, 0x4235, 0x5214, 0x6277, 0x7256,
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	82 0xB5EA, 0xA5CB, 0x95A8, 0x8589, 0xF56E, 0xE54F, 0xD52C, 0xC50D,
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	83 0x34E2, 0x24C3, 0x14A0, 0x0481, 0x7466, 0x6447, 0x5424, 0x4405,
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	84 0xA7DB, 0xB7FA, 0x8799, 0x97B8, 0xE75F, 0xF77E, 0xC71D, 0xD73C,
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	85 0x26D3, 0x36F2, 0x0691, 0x16B0, 0x6657, 0x7676, 0x4615, 0x5634,
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	86 0xD94C, 0xC96D, 0xF90E, 0xE92F, 0x99C8, 0x89E9, 0xB98A, 0xA9AB,
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	87 0x5844, 0x4865, 0x7806, 0x6827, 0x18C0, 0x08E1, 0x3882, 0x28A3,
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	88 0xCB7D, 0xDB5C, 0xEB3F, 0xFB1E, 0x8BF9, 0x9BD8, 0xABBB, 0xBB9A,
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	89 0x4A75, 0x5A54, 0x6A37, 0x7A16, 0x0AF1, 0x1AD0, 0x2AB3, 0x3A92,
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	90 0xFD2E, 0xED0F, 0xDD6C, 0xCD4D, 0xBDAA, 0xAD8B, 0x9DE8, 0x8DC9,
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	91 0x7C26, 0x6C07, 0x5C64, 0x4C45, 0x3CA2, 0x2C83, 0x1CE0, 0x0CC1,
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	92 0xEF1F, 0xFF3E, 0xCF5D, 0xDF7C, 0xAF9B, 0xBFBA, 0x8FD9, 0x9FF8,
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	93 0x6E17, 0x7E36, 0x4E55, 0x5E74, 0x2E93, 0x3EB2, 0x0ED1, 0x1EF0
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 /==== FUNCTIONS ===================================================/
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 \| PROJECT : GSM-F&D (8411) MODULE : T30_BCSF \|
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	101 \| STATE : code ROUTINE : bcs_build_report \|
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	102 +--------------------------------------------------------------------+
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 PURPOSE : build the T30_REPORT_IND primitive out of a send/rec. frame
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 */
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 LOCAL void bcs_build_report(UBYTE frame, USHORT len, T_T30_REPORT_IND t30_report_ind)
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	109 {
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	110 if (t30_data->bitorder & FBO_REV_STATUS) /* reverse the bitorder of each byte */
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	111 {
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	112 memcpy(t30_report_ind->sdu.buf, frame, len);
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 else
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	115 {
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	116 USHORT i;
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	117 for (i=0; i<len; i++)
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	118 t30_report_ind->sdu.buf[i] = BIT_MIRROR[frame[i]];
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
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	121 t30_report_ind->sdu.l_buf = (len << 3);
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	122 t30_report_ind->sdu.o_buf = 0;
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	123 }
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	124
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	125 /*
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	126 +--------------------------------------------------------------------+
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	127 \| PROJECT : GSM-F&D (8411) MODULE : T30_BCSF \|
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	128 \| STATE : code ROUTINE : bcs_init \|
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 PURPOSE : initialize BCS formatter
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 */
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	134
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	135 GLOBAL void bcs_init(T_T30_DATA *pt30_data)
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 TRACE_FUNCTION ("bcs_init()");
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	138 memset (pt30_data->bcs_frm, 0, BCS_FRM_SIZE);
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 /*
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 \| PROJECT : GSM-F&D (8411) MODULE : T30_BCSF \|
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	144 \| STATE : code ROUTINE : bcs_check_frames \|
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	145 +--------------------------------------------------------------------+
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 PURPOSE : This function checks the final flag and the frame checking sequence.
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
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	150 LOCAL UBYTE bcs_check_frames(UBYTE *idx_max)
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 T_sdu sdu = (T_sdu)t30_data->bcs_frm;
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	154 UBYTE idx;
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	155
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	156 for (idx = 0; idx < *idx_max; idx++)
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 #ifdef _SIMULATION_ /* FCS generating/checking off */
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	159 if (t30_data->test_mode & TST_FCS)
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	160 {
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	161 }
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	162 else
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	163 #endif
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 USHORT crctt = 0xffff; /* initialize crc */
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	166
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	167 /* shift each bit through polynomial */
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	168 USHORT pos;
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	169 for (pos = t30_data->frm[idx].beg; pos <= t30_data->frm[idx].end; pos++)
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	170 {
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	171 SHORT tmp = (crctt >> 8) ^ sdu->buf[pos];
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	172 crctt = ((crctt << 8) ^ crctab[tmp & 0xff]) & 0xffff;
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	173 }
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	174 if (crctt NEQ 0x1D0F) /* check remainder */
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	175 return CHK_FCS_ERR;
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	176 }
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	177 #if defined _SIMULATION_ \|\| defined KER_DEBUG_BCS
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	178 ker_debug ("BCS_DATA_IND", (UBYTE*)&sdu->buf[t30_data->frm[idx].beg], (USHORT)(t30_data->frm[idx].end-t30_data->frm[idx].beg));
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	179 #endif
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	180 /* count final flags */
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	181 if (sdu->buf[t30_data->frm[idx].beg + 1] & 0x08)
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	182 {
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	183 *idx_max = (UBYTE)idx + 1;
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	184 return CHK_OK;
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	185 }
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	186 }
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	187 #ifdef _SIMULATION_ /* Control checking OFF */
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	188 if (t30_data->test_mode & TST_CTRL)
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	189 return CHK_OK;
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	190 #endif
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	191 return CHK_FIN_ERR;
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 /*
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	195 +--------------------------------------------------------------------+
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	196 \| PROJECT : GSM-F&D (8411) MODULE : T30_BCSF \|
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	197 \| STATE : code ROUTINE : bcs_frame_pos \|
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	198 +--------------------------------------------------------------------+
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 PURPOSE : This function extracts
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	201 the beginning, the end and the length of each frame.
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	202 */
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	203
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	204 LOCAL UBYTE bcs_frame_pos(UBYTE flag_vector, UBYTE idx_max)
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	205 {
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	206 USHORT idx = 0;
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	207 T_sdu sdu = (T_sdu)t30_data->bcs_frm;
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 *idx_max = 0;
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	210 while (idx < sdu->l_buf)
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	211 {
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	212 /* skip flags */
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	213 while (idx < sdu->l_buf AND flag_vector[idx])
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	214 idx++;
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 /* ready if last byte is a flag */
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	217 if (idx EQ sdu->l_buf)
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	218 return FRM_OK;
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 /* save begin of frame */
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	221 t30_data->frm[*idx_max].beg = idx;
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 /* search flag */
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	224 while (idx < sdu->l_buf AND !flag_vector[idx])
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	225 idx++;
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	226
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	227 /* error if no flag found */
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	228 if (idx EQ sdu->l_buf)
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	229 {
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	230 t30_data->frm[*idx_max].beg = 0;
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	231 return FRM_OK; /* return FRM_ERR_NO_FLAG; ??? */
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
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	234 /* save end of fame and length of frame */
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	235 t30_data->frm[*idx_max].end = idx - 1;
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	236 t30_data->frm[idx_max].len = idx - t30_data->frm[idx_max].beg;
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	237
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	238 /* error if too many frames received */
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	239 if (++(*idx_max) EQ FRAMES_MAX)
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	240 return FRM_ERR_TOO_MANY_FRAMES;
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	241
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	242 /* next frame */
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	243 idx++;
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	244 }
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	245 return FRM_OK;
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
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 +--------------------------------------------------------------------+
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	250 \| PROJECT : GSM-F&D (8411) MODULE : T30_BCSF \|
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	251 \| STATE : code ROUTINE : bcs_report_rcv \|
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 PURPOSE : This function reports the received HDLC frames to MMI
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	255 if desired.
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	256 */
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 LOCAL void bcs_report_rcv(UBYTE idx_max)
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 T_sdu sdu = (T_sdu)t30_data->bcs_frm;
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	261 USHORT idx;
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 for (idx = 0 ; idx < idx_max ; idx++)
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 if (t30_data->frm[idx].len >= 2)
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 PALLOC_SDU (t30_report_ind, T30_REPORT_IND, REPORT_SIZE_BITS);
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	268 bcs_build_report (&sdu->buf[t30_data->frm[idx].beg], (USHORT)(t30_data->frm[idx].len - 2), t30_report_ind);
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	269 t30_report_ind->dir = DIR_RCV;
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	270 PSENDX (MMI, t30_report_ind);
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	271 }
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	272 }
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	273 }
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	274
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 +--------------------------------------------------------------------+
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	277 \| PROJECT : GSM-F&D (8411) MODULE : T30_BCSF \|
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	278 \| STATE : code ROUTINE : bcs_decode \|
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
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	281 PURPOSE : This function decodes each hdlc frame and sends the
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	282 decoded data to the kernel.
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 /* this function is only necessary because of an iarm compiler failure */
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	286 LOCAL void bcs_clear_flag (UBYTE *ptr)
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	287 {
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	288 if (*ptr & 0x70)
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	289 *ptr &= 0x7F;
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	290 }
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 LOCAL UBYTE bcs_decode(UBYTE idx_max)
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 T_sdu sdu = (T_sdu)t30_data->bcs_frm;
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	295 UBYTE idx;
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	296
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	297 for (idx = 0; idx < idx_max; idx++)
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 USHORT begin = t30_data->frm[idx].beg + 2;
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	300
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	301 /* set direction flag to zero for CCD decoding */
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	302 bcs_clear_flag (sdu->buf + begin);
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	303
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	304 /* set offset and length of current frame */
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	305 sdu->o_buf = begin << 3;
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	306 sdu->l_buf = ((USHORT)(t30_data->frm[idx].len - 4) << 3);
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	307
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	308 #ifdef _SIMULATION_ /* show contents of buffer */
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	309 if (t30_data->test_mode /* & TST_BUF */)
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	310 {
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	311 ker_debug ("ccd_decode", &sdu->buf[begin], (USHORT)(sdu->l_buf >> 3));
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	312 }
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	313 #endif
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	314
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	315 if (ccd_decodeMsg(CCDENT_T30, DOWNLINK, (T_MSGBUF*)sdu, _decodedMsg, HDLC_ADDR) EQ ccdError)
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 TRACE_EVENT ("ERROR: ccd_decode");
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	318 return CCD_ERR;
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	319 }
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	320 sig_bcs_ker_bdat_ind(); /* send signal to kernel */
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	321 }
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	322 return CCD_OK;
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	323 }
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	324
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 \| PROJECT : GSM-F&D (8411) MODULE : T30_BCSF \|
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	328 \| STATE : code ROUTINE : bcs_destuff \|
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
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	331 PURPOSE : This function de-stuffs the received BCS data.
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	332 */
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 LOCAL void bcs_destuff(UBYTE *flag_vector)
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	335 {
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	336 T_sdu sdu = (T_sdu)t30_data->bcs_frm;
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	337 SHORT bcs_tmp_len = 0;
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	338 SHORT ones = 0;
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	339 SHORT bits = 8;
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	340 UBYTE flag = 0;
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	341 UBYTE *bcs_tmp;
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	342 SHORT i;
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	343
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	344 #ifdef _SIMULATION_ /* bit stuffing/destuffing OFF */
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	345 if (t30_data->test_mode & TST_STUFF)
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 for (i = 0; i < sdu->l_buf; i++)
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 if (sdu->buf[i] EQ HDLC_FLAG)
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	350 flag_vector[i] = 1;
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 if (flag_vector[sdu->l_buf-1] NEQ 1) // trailing HDLC_FLAG is missed
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 sdu->l_buf++;
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	355 sdu->buf[sdu->l_buf-1] = HDLC_FLAG;
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	356 flag_vector[sdu->l_buf-1] = 1;
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 return;
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	359 }
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	360 #endif
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 MALLOC(bcs_tmp, sdu->l_buf);
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	363
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	364 for (i = 0 ; i < sdu->l_buf ; i++)
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 UBYTE bit_ptr = 0x80; /* points initially to MSB */
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 do /* check each byte for destuffing */
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 if (sdu->buf[i] & bit_ptr) /* bit pointed to is 1 */
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 ones++;
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	373 bcs_tmp[bcs_tmp_len] = (bcs_tmp[bcs_tmp_len] << 1) \| 1;
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	374 flag = (flag << 1) \| 1;
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	375
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	376 if (! --bits) /* counter of byte's bits*/
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 bcs_tmp_len++;
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	379 bits = 8;
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 else /* bit is 0 */
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	383 {
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	384 if (ones != 5)
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	385 {
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	386 bcs_tmp[bcs_tmp_len] <<= 1;
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	387 flag <<= 1;
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 if (ones EQ 6 && flag EQ HDLC_FLAG)
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	390 flag_vector[bcs_tmp_len] = 1;
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	391
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	392 if (! --bits) /* whole byte is scanned */
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	393 {
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	394 bcs_tmp_len++;
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	395 bits = 8;
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	396 }
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 ones = 0;
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 bit_ptr >>= 1;
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	401 }
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	402 while (bit_ptr);
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 /* copy destuffed BCS frame back to sdu */
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	405 memcpy (sdu->buf, bcs_tmp, bcs_tmp_len);
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	406 MFREE(bcs_tmp);
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 sdu->l_buf = bcs_tmp_len; /* adjust buffer length */
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	409 if (flag_vector[sdu->l_buf-1] NEQ 1) // trailing HDLC_FLAG is missed
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	410 {
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	411 sdu->l_buf++;
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	412 sdu->buf[sdu->l_buf-1] = HDLC_FLAG;
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	413 flag_vector[sdu->l_buf-1] = 1;
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	414 }
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	415 }
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	416
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	417 /*
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	418 +--------------------------------------------------------------------+
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	419 \| PROJECT : GSM-F&D (8411) MODULE : T30_BCSF \|
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	420 \| STATE : code ROUTINE : bcs_bcs_decode \|
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
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	423 PURPOSE : This function gets the frame positions,
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	424 checks the frames,
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	425 reports the contents to MMI if desired,
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	426 decodes the contents and sends the contents to the kernel.
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	427 */
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 GLOBAL void bcs_bcs_decode(void)
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 UBYTE *flag_vector, idx_max, ret;
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	432
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	433 MALLOC(flag_vector, BCS_FRM_SIZE);
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	434 memset(flag_vector, 0, BCS_FRM_SIZE);
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	435 bcs_destuff(flag_vector);
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	436 ret = bcs_frame_pos(flag_vector, &idx_max); /* determines "idx_max" */
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	437 MFREE(flag_vector);
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	438
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	439 switch (ret)
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 case FRM_OK:
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	442 ret = bcs_check_frames(&idx_max);
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	443 if (t30_data->hdlc_report)
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	444 {
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	445 bcs_report_rcv(idx_max);
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	446 }
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	447 switch (ret)
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	448 {
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	449 case CHK_OK:
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	450 switch (bcs_decode(idx_max))
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	451 {
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	452 case CCD_OK:
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	453 return;
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	454
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	455 case CCD_ERR:
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	456 sig_bcs_ker_err_ind(ERR_CCD_DEC);
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	457 return;
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 break; /* dummy */
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	460
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	461 case CHK_FCS_ERR:
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	462 sig_bcs_ker_err_ind(ERR_FCS);
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	463 return;
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 case CHK_FIN_ERR:
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	466 sig_bcs_ker_err_ind(ERR_FINAL);
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	467 return;
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 break;
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 case FRM_ERR_NO_FLAG:
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	472 sig_bcs_ker_err_ind(ERR_FRAME_NO_FLAG);
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	473 return;
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 case FRM_ERR_TOO_MANY_FRAMES:
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	476 sig_bcs_ker_err_ind(ERR_FRAME_TOO_MANY_FRAMES);
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	477 return;
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	478 }
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
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 +--------------------------------------------------------------------+
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	483 \| PROJECT : GSM-F&D (8411) MODULE : T30_BCSF \|
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	484 \| STATE : code ROUTINE : bcs_report_snd \|
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	485 +--------------------------------------------------------------------+
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 PURPOSE : This function reports the sent HDLC frames to MMI
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	488 if desired.
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 LOCAL void bcs_report_snd(void)
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	492 {
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	493 T_sdu BCI_stream = (T_sdu)t30_data->BCI_stream; // Binary Coded Information
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 PALLOC_SDU(t30_report_ind, T30_REPORT_IND, REPORT_SIZE_BITS);
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	496
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	497 bcs_build_report(&BCI_stream->buf[0], (USHORT)((BCI_stream->l_buf >> 3) + 2), t30_report_ind);
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	498 t30_report_ind->dir = DIR_SND;
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	499 PSENDX (MMI, t30_report_ind);
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	500 }
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 /*
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	503 +--------------------------------------------------------------------+
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	504 \| PROJECT : GSM-F&D (8411) MODULE : T30_BCSF \|
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	505 \| STATE : code ROUTINE : bcs_fcs_gen \|
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	506 +--------------------------------------------------------------------+
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	507
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	508 PURPOSE : This function generates the frame checking sequence
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	509 for one HDLC frame.
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
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	512 LOCAL void bcs_fcs_gen (void)
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	513 {
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	514 T_sdu sdu = (T_sdu)t30_data->BCI_stream;
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	515 USHORT end = (sdu->l_buf >> 3) + 2;
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	516 USHORT pos;
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	517 UBYTE i;
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	518
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	519 #ifdef _SIMULATION_ /* FCS generating/checking OFF */
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	520 if (t30_data->test_mode & TST_FCS)
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	521 {
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	522 pos = end;
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	523 sdu->buf[pos++] = 0x12;
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	524 sdu->buf[pos++] = 0xEF;
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 else
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	527 #endif
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 USHORT crctt = 0xffff;
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	530 for (pos = 0; pos < end; pos++)
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 SHORT tmp = (crctt >> 8) ^ sdu->buf[pos];
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	533 crctt = ((crctt << 8) ^ crctab[tmp & 0xff]) & 0xffff;
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 sdu->buf[pos++] = (~(crctt & 0xffff) & 0xffff) >> 8;/lint !e661 !e662 (Warning -- Possible access/creation of out-of-bounds pointer)/
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	536 sdu->buf[pos++] = (~(crctt & 0xffff) & 0xff);/lint !e661 !e662 (Warning -- Possible access/creation of out-of-bounds pointer)/
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	537 }
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	538
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	539 sdu->l_buf += 32; /* 4 bytes more */
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	540
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	541 for (i = 0; i < HDLC_FLAGS; i++)
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	542 {
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	543 sdu->buf[pos++] = HDLC_FLAG;/lint !e661 !e662 (Warning -- Possible access/creation of out-of-bounds pointer)/
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	544 sdu->l_buf += 8;
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 sdu->o_buf = 0;
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	547 }
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 /*
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 \| PROJECT : GSM-F&D (8411) MODULE : T30_BCSF \|
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	552 \| STATE : code ROUTINE : bcs_stuff \|
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	553 +--------------------------------------------------------------------+
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	554
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	555 PURPOSE : This function stuffs the BCS data.
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
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	558 LOCAL void bcs_stuff (UBYTE final)
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 T_sdu sdu_inp = (T_sdu)t30_data->BCI_stream;
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	561 T_sdu *sdu_out = &t30_data->fad_data_req->sdu;
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	562
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	563 UBYTE *buf_in = sdu_inp->buf;
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	564 USHORT len_in = sdu_inp->l_buf >> 3;
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	565 UBYTE *buf_out;
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	566 USHORT len_out = sdu_out->l_buf >> 3;
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	567 USHORT i;
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	568
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	569 #ifdef _SIMULATION_ /* bit stuffing/destuffing OFF */
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	570 if (t30_data->test_mode & TST_STUFF)
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 buf_out = &sdu_out->buf[len_out];
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	573 memcpy (buf_out, buf_in, len_in);
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	574 sdu_out->l_buf = (len_out + len_in) << 3;
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	575 return;
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	576 }
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	577 #endif
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	578
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	579 buf_out = sdu_out->buf;
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	580
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	581 for (i = 0; i < len_in; i++)
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	582 {
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	583 USHORT bit_ptr = 0x80;
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	584 UBYTE stuff = 1;
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	585 /*
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	586 check HDLC_FLAGS
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	587 */
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	588 if (buf_in[i] EQ HDLC_FLAG)
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	589 {
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	590 USHORT k;
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	591 for (k = 0; k < HDLC_FLAGS; k++)
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	592 {
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	593 if (i EQ len_in - k - 1)
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	594 {
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	595 stuff = 0;
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	596 break;
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	597 }
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	598 }
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	599 }
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	600 do
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	601 {
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	602 switch (buf_in[i] & bit_ptr)
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	603 {
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	604 default:
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	605 buf_out[len_out] = (buf_out[len_out] << 1) \| 1;
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	606 if (! --t30_data->stuff_bits)
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	607 {
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	608 len_out++;
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	609 t30_data->stuff_bits = 8;
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	610 }
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	611 if (!stuff)
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	612 {
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	613 t30_data->stuff_ones = 0;
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	614 break;
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	615 }
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	616 if (++t30_data->stuff_ones != 5)
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	617 break;
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	618 /*
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	619 * otherwise fall through
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	620 */
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	621
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	622 case 0:
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	623 buf_out[len_out] <<= 1;
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	624 t30_data->stuff_ones = 0;
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	625
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	626 if (! --t30_data->stuff_bits)
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	627 {
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	628 len_out++;
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	629 t30_data->stuff_bits = 8;
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	630 }
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	631 break;
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	632 }
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	633 bit_ptr >>= 1;
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	634 } while (bit_ptr);
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	635 }
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	636
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	637 if (final EQ FINAL_YES AND t30_data->stuff_bits NEQ 8)
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	638 {
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	639 buf_out[len_out] <<= t30_data->stuff_bits;
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	640 len_out++;
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	641 }
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	642
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	643 sdu_out->l_buf = len_out << 3;
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	644
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	645 if (final EQ FINAL_YES)
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	646 {
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	647 t30_data->stuff_ones = 0;
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	648 t30_data->stuff_bits = 8;
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	649 }
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	650 }
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	651
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	652 /*
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	653 +--------------------------------------------------------------------+
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	654 \| PROJECT : GSM-F&D (8411) MODULE : T30_BCSF \|
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	655 \| STATE : code ROUTINE : bcs_bcs_encode \|
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	656 +--------------------------------------------------------------------+
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	657
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	658 PURPOSE : This function encodes the HDLC frames,
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	659 reports the HDLC frames to MMI if desired,
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	660 generates the frame checking sequence and stuffs the bits.
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	661 */
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	662
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	663 GLOBAL void bcs_bcs_encode(UBYTE ctrl, UBYTE final)
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	664 {
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	665 T_sdu sdu = (T_sdu)t30_data->BCI_stream;
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	666
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	667 switch (sdu->buf[2])/lint !e415 !e416 (Warning -- access/creation of out-of-bounds pointer)/
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	668 {
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	669 case BCS_DIS:
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	670 TRACE_EVENT ("Send BCS_DIS");
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	671 break;
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	672 case BCS_CSI:
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	673 TRACE_EVENT ("Send BCS_CSI");
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	674 break;
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	675 case BCS_NSF:
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	676 TRACE_EVENT ("Send BCS_NSF");
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	677 break;
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	678 case BCS_DTC:
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	679 TRACE_EVENT ("Send BCS_DTC");
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	680 break;
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	681 case BCS_CIG:
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	682 TRACE_EVENT ("Send BCS_CIG");
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	683 break;
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	684 case BCS_NSC:
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	685 TRACE_EVENT ("Send BCS_NSC");
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	686 break;
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	687 case BCS_PWD_POLL:
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	688 TRACE_EVENT ("Send BCS_PWD_POLL");
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	689 break;
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	690 case BCS_SEP:
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	691 TRACE_EVENT ("Send BCS_SEP");
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	692 break;
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	693
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	694 case BCS_CFR:
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	695 TRACE_EVENT ("Send BCS_CFR");
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	696 sdu->buf[2] \|= t30_data->dir;/lint !e415 !e416 (Warning -- access/creation of out-of-bounds pointer)/
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	697 break;
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	698 case BCS_CRP:
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	699 TRACE_EVENT ("Send BCS_CRP");
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	700 sdu->buf[2] \|= t30_data->dir;/lint !e415 !e416 (Warning -- access/creation of out-of-bounds pointer)/
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	701 break;
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	702 case BCS_DCN:
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	703 TRACE_EVENT ("Send BCS_DCN");
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	704 sdu->buf[2] \|= t30_data->dir;/lint !e415 !e416 (Warning -- access/creation of out-of-bounds pointer)/
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	705 break;
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	706 case BCS_DCS:
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	707 TRACE_EVENT ("Send BCS_DCS");
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	708 sdu->buf[2] \|= t30_data->dir;/lint !e415 !e416 (Warning -- access/creation of out-of-bounds pointer)/
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	709 break;
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	710 case BCS_EOM:
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	711 TRACE_EVENT ("Send BCS_EOM");
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	712 sdu->buf[2] \|= t30_data->dir;/lint !e415 !e416 (Warning -- access/creation of out-of-bounds pointer)/
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	713 break;
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	714 case BCS_EOP:
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	715 TRACE_EVENT ("Send BCS_EOP");
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	716 sdu->buf[2] \|= t30_data->dir;/lint !e415 !e416 (Warning -- access/creation of out-of-bounds pointer)/
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	717 break;
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	718 case BCS_FTT:
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	719 TRACE_EVENT ("Send BCS_FTT");
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	720 sdu->buf[2] \|= t30_data->dir;/lint !e415 !e416 (Warning -- access/creation of out-of-bounds pointer)/
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	721 break;
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	722 case BCS_MCF:
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	723 TRACE_EVENT ("Send BCS_MCF");
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	724 sdu->buf[2] \|= t30_data->dir;/lint !e415 !e416 (Warning -- access/creation of out-of-bounds pointer)/
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	725 break;
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	726 case BCS_MPS:
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	727 TRACE_EVENT ("Send BCS_MPS");
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	728 sdu->buf[2] \|= t30_data->dir;/lint !e415 !e416 (Warning -- access/creation of out-of-bounds pointer)/
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	729 break;
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	730 case BCS_NSS:
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	731 TRACE_EVENT ("Send BCS_NSS");
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	732 sdu->buf[2] \|= t30_data->dir;/lint !e415 !e416 (Warning -- access/creation of out-of-bounds pointer)/
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	733 break;
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	734 case BCS_PIN:
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	735 TRACE_EVENT ("Send BCS_PIN");
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	736 sdu->buf[2] \|= t30_data->dir;/lint !e415 !e416 (Warning -- access/creation of out-of-bounds pointer)/
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	737 break;
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	738 case BCS_PIP:
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	739 TRACE_EVENT ("Send BCS_PIP");
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	740 sdu->buf[2] \|= t30_data->dir;/lint !e415 !e416 (Warning -- access/creation of out-of-bounds pointer)/
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	741 break;
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	742 case BCS_PRI_EOM:
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	743 TRACE_EVENT ("Send BCS_PRI_EOM");
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	744 sdu->buf[2] \|= t30_data->dir;/lint !e415 !e416 (Warning -- access/creation of out-of-bounds pointer)/
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	745 break;
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	746 case BCS_PRI_EOP:
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	747 TRACE_EVENT ("Send BCS_PRI_EOP");
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	748 sdu->buf[2] \|= t30_data->dir;/lint !e415 !e416 (Warning -- access/creation of out-of-bounds pointer)/
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	749 break;
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	750 case BCS_PRI_MPS:
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	751 TRACE_EVENT ("Send BCS_PRI_MPS");
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	752 sdu->buf[2] \|= t30_data->dir;/lint !e415 !e416 (Warning -- access/creation of out-of-bounds pointer)/
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	753 break;
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	754 case BCS_PWD_SND:
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	755 TRACE_EVENT ("Send BCS_PWD_SND");
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	756 sdu->buf[2] \|= t30_data->dir;/lint !e415 !e416 (Warning -- access/creation of out-of-bounds pointer)/
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	757 break;
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	758 case BCS_RTN:
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	759 TRACE_EVENT ("Send BCS_RTN");
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	760 sdu->buf[2] \|= t30_data->dir;/lint !e415 !e416 (Warning -- access/creation of out-of-bounds pointer)/
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	761 break;
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	762 case BCS_RTP:
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	763 TRACE_EVENT ("Send BCS_RTP");
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	764 sdu->buf[2] \|= t30_data->dir;/lint !e415 !e416 (Warning -- access/creation of out-of-bounds pointer)/
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	765 break;
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	766 case BCS_SUB:
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	767 TRACE_EVENT ("Send BCS_SUB");
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	768 sdu->buf[2] \|= t30_data->dir;/lint !e415 !e416 (Warning -- access/creation of out-of-bounds pointer)/
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	769 break;
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	770 case BCS_TSI:
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	771 TRACE_EVENT ("Send BCS_TSI");
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	772 sdu->buf[2] \|= t30_data->dir;/lint !e415 !e416 (Warning -- access/creation of out-of-bounds pointer)/
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	773 break;
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	774 }
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	775
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	776 sdu->buf[0] = HDLC_ADDR;
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	777 sdu->buf[1] = ctrl;/lint !e415 (Warning -- access of out-of-bounds pointer)/
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	778
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	779 if (t30_data->hdlc_report)
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	780 {
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	781 bcs_report_snd();
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	782 }
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	783 bcs_fcs_gen();
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	784 bcs_stuff(final);
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	785 }
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	786
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	787 /*
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	788 +--------------------------------------------------------------------+
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	789 \| PROJECT : GSM-F&D (8411) MODULE : T30_BCSF \|
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	790 \| STATE : code ROUTINE : bcs_fill_bcs_frm \|
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	791 +--------------------------------------------------------------------+
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	792
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	793 PURPOSE : This function checks if the BCS frame buffer has enough
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	794 space to append the received data.
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	795 If there is enough space the data is appended.
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	796 If not than BCS_FRM_FULL is returned.
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	797
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	798 */
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	799
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	800 GLOBAL UBYTE bcs_fill_bcs_frm (T_FAD_DATA_IND *fad_data_ind)
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	801 {
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	802 USHORT data_len = fad_data_ind->sdu.l_buf >> 3;
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	803 T_sdu sdu = (T_sdu)t30_data->bcs_frm;
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	804
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	805 TRACE_FUNCTION("bcs_fill_bcs_frm()");
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	806
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	807 if (sdu->l_buf + data_len < BCS_FRM_SIZE)
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	808 {
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	809 memcpy (&sdu->buf[sdu->l_buf], fad_data_ind->sdu.buf, data_len);
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	810 sdu->l_buf += data_len;
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	811 return ((fad_data_ind->final) ? BCS_FRM_FILLED : BCS_FRM_FILLING);
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	812 }
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	813 else
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	814 {
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	815 sdu->l_buf = BCS_FRM_SIZE;
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	816 return (BCS_FRM_FULL);
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	817 }
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	818 }
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	819

FreeCalypso > hg > fc-magnetite

annotate src/g23m-fad/t30/t30_bcsf.c @ 597:f18b29e27be5