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

annotate src/g23m-fad/t30/t30_bcsf.c @ 221:5bf097aeaad7

LLS: when turning off all LEDs on boot, skip LED-C Having LLS turn off LED-A and LED-B on boot is normally unnecessary (they should already be off in Iota), but it is harmless, hence this logic is kept for robustness. However, having LLS read-modify-write the BCICTL2 register (to turn off LED-C) creates a potential race condition with FCHG writes to this register, especially in the case when baseband switch-on is caused by VCHG and charging is expected to start right away. Furthermore, control of the charging LED itself (on those hw targets that have it) is the responsibility of the FCHG SWE, hence LLS should leave it alone.

author	Mychaela Falconia <falcon@freecalypso.org>
date	Mon, 26 Apr 2021 21:55:13 +0000
parents	fa8dc04885d8
children

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

FreeCalypso > hg > fc-tourmaline

annotate src/g23m-fad/t30/t30_bcsf.c @ 221:5bf097aeaad7