FreeCalypso > hg > fc-magnetite
view src/g23m-gprs/sndcp/sndcp_mgf.c @ 673:62a5285e014a
Lorekeeping: allow tpudrv-leonardo.lib on Leonardo/Tango
Back in 2015 the Mother's idea was to produce a FreeCalypso development
board that would be a clone of TI Leonardo, including the original
quadband RFFE; one major additional stipulation was that this board
needed to be able to run original unmodified TCS211-20070608 firmware
with all blobs intact, with only minimal binary patches to main.lib
and tpudrv.lib. The necessary patched libs were produced at that time
in the tcs211-patches repository.
That plan was changed and we produced FCDEV3B instead, with Openmoko's
triband RFFE instead of Leonardo quadband, but when FC Magnetite started
in 2016, a TPUDRV_blob= provision was still made, allowing the possibility
of patching OM's tpudrv.lib for a restored Leonardo RFFE.
Now in 2020 we have FC Tango which is essentially a verbatim clone of
Leonardo core, including the original quadband RFFE. We have also
deblobbed our firmware so much that we have absolutely no real need
for a blob version of tpudrv.lib - but I thought it would be neat to put
the ancient TPUDRV_blob= mechanism (classic config) to its originally
intended use, just for the heck of it.
author | Mychaela Falconia <falcon@freecalypso.org> |
---|---|
date | Fri, 29 May 2020 03:55:36 +0000 |
parents | 219afcfc6250 |
children |
line wrap: on
line source
/* +----------------------------------------------------------------------------- | Project : GPRS (8441) | Modul : sndcp_mgf.c +----------------------------------------------------------------------------- | Copyright 2002 Texas Instruments Berlin, AG | All rights reserved. | | This file is confidential and a trade secret of Texas | Instruments Berlin, AG | The receipt of or possession of this file does not convey | any rights to reproduce or disclose its contents or to | manufacture, use, or sell anything it may describe, in | whole, or in part, without the specific written consent of | Texas Instruments Berlin, AG. +----------------------------------------------------------------------------- | Purpose : This modul is part of the entity SNDCP and implements all | procedures and functions as described in the | SDL-documentation (MG-statemachine) +----------------------------------------------------------------------------- */ #define ENTITY_SNDCP /*==== INCLUDES =============================================================*/ #include "typedefs.h" /* to get Condat data types */ #include "vsi.h" /* to get a lot of macros */ #include "macdef.h" #include "gsm.h" /* to get a lot of macros */ #include "prim.h" /* to get the definitions of used SAP and directions */ #include "dti.h" #include "sndcp.h" /* to get the global entity definitions */ #include "sndcp_f.h" /* to get the functions to access the global arrays*/ #include "sndcp_cias.h" /* to get the signals to service cia */ #include "sndcp_nds.h" /* to get the signals to service nd */ #include "sndcp_nus.h" /* to get the signals to service nu */ #include "sndcp_nuf.h" #include "sndcp_sus.h" /* to get the signals to service su */ #include "sndcp_suas.h" /* to get the signals to service su */ #include "sndcp_sds.h" /* to get the signals to service sd */ #include "sndcp_sdas.h" /* to get the signals to service sda */ #include "sndcp_mgf.h" /* to get ths file */ #include "sndcp_nup.h" /* nu_sn_[unit]data_req is called from sig_callback().*/ #include <string.h> /*==== CONST ================================================================*/ /*==== LOCAL VARS ===========================================================*/ /*==== PRIVATE FUNCTIONS ====================================================*/ LOCAL void mg_get_sapi_dcomp_dntt (UBYTE sapi, UBYTE dcomp, UBYTE* dntt); LOCAL void mg_get_sapi_dntt_nsapi (UBYTE sapi, UBYTE dntt, UBYTE nsapi, BOOL* used); LOCAL void mg_get_sapi_dntt_state (UBYTE sapi, UBYTE dntt, UBYTE* state); LOCAL void mg_get_sapi_dcomp_state (UBYTE sapi, UBYTE dcomp, UBYTE* stat); LOCAL void mg_get_sapi_pcomp_state (UBYTE sapi, UBYTE pcomp, UBYTE* stat); LOCAL void mg_get_sapi_pntt_state (UBYTE sapi, UBYTE pntt, UBYTE* state); LOCAL void mg_set_sapi_dntt_nsapi (UBYTE sapi, UBYTE dntt, UBYTE nsapi, BOOL used); LOCAL void mg_set_sapi_dcomp_state (UBYTE sapi, UBYTE dcomp, UBYTE stat); LOCAL void mg_set_sapi_dcomp_dntt (UBYTE sapi, UBYTE dcomp, UBYTE dntt); LOCAL void mg_set_sapi_dntt_rej (UBYTE sapi, UBYTE dntt, BOOL rej); LOCAL void mg_set_sapi_dntt_state (UBYTE sapi, UBYTE dntt, UBYTE state); LOCAL void mg_set_sapi_pntt_nsapi (UBYTE sapi, UBYTE pntt, UBYTE nsapi, BOOL used); LOCAL void mg_set_sapi_pcomp_state (UBYTE sapi, UBYTE pcomp, UBYTE stat); LOCAL void mg_set_sapi_pcomp_pntt (UBYTE sapi, UBYTE pcomp, UBYTE pntt); LOCAL void mg_set_sapi_pntt_rej (UBYTE sapi, UBYTE pntt, BOOL rej); LOCAL void mg_set_sapi_pntt_state (UBYTE sapi, UBYTE pntt, UBYTE state); /* +------------------------------------------------------------------------------ | Function : mg_get_sapi_dcomp_dntt +------------------------------------------------------------------------------ | Description : The procedures indicates the dntt assigned to a given dcomp | for a given sapi. | | Parameters : FPAR IN sapi UBYTE, | IN dcomp UBYTE, | IN/OUT dntt UBYTE | +------------------------------------------------------------------------------ */ LOCAL void mg_get_sapi_dcomp_dntt (UBYTE sapi, UBYTE dcomp, UBYTE* dntt) { TRACE_FUNCTION( "mg_get_sapi_dcomp_dntt" ); { UBYTE sapi_index = 0; sndcp_get_sapi_index(sapi, &sapi_index); *dntt = sndcp_data->mg.sapi_dcomp_dntt_ra[sapi_index][dcomp]; } } /* mg_get_sapi_dcomp_dntt() */ /* +------------------------------------------------------------------------------ | Function : mg_get_sapi_dntt_nsapi +------------------------------------------------------------------------------ | Description : The procedure informs if a given nsapi uses a given dntt on a | given sapi. | | Parameters : FPAR IN sapi UBYTE, | IN dntt UBYTE, | IN nsapi UBYTE, | IN/OUT used BOOL | +------------------------------------------------------------------------------ */ LOCAL void mg_get_sapi_dntt_nsapi (UBYTE sapi, UBYTE dntt, UBYTE nsapi, BOOL* used) { TRACE_FUNCTION( "mg_get_sapi_dntt_nsapi" ); { UBYTE sapi_index = 0; sndcp_get_sapi_index(sapi, &sapi_index); *used = sndcp_data->mg.sapi_dntt_nsapi_set_ra[sapi_index][dntt][nsapi]; } } /* mg_get_sapi_dntt_nsapi() */ /* +------------------------------------------------------------------------------ | Function : mg_get_sapi_dcomp_state +------------------------------------------------------------------------------ | Description : The procedures informs about the state of a given dcomp on a | given SAPI. | | Parameters : FPAR IN sapi UBYTE, | IN dcomp UBYTE, | IN/OUT stat UBYTE | +------------------------------------------------------------------------------ */ LOCAL void mg_get_sapi_dcomp_state (UBYTE sapi, UBYTE dcomp, UBYTE* stat) { TRACE_FUNCTION( "mg_get_sapi_dcomp_state" ); { UBYTE sapi_index = 0; sndcp_get_sapi_index(sapi, &sapi_index); *stat = sndcp_data->mg.sapi_dcomp_state_ra[sapi_index][dcomp]; } } /* mg_get_sapi_dcomp_state() */ /* +------------------------------------------------------------------------------ | Function : mg_get_sapi_dntt_state +------------------------------------------------------------------------------ | Description : The procedures informs about the state of a given data | compression entity on a given SAPI. | | Parameters : FPAR IN sapi UBYTE, | IN dntt UBYTE, | IN/OUT state UBYTE | +------------------------------------------------------------------------------ */ LOCAL void mg_get_sapi_dntt_state (UBYTE sapi, UBYTE dntt, UBYTE* state) { TRACE_FUNCTION( "mg_get_sapi_dntt_state" ); { UBYTE sapi_index = 0; sndcp_get_sapi_index(sapi, &sapi_index); *state = sndcp_data->mg.sapi_dntt_state_ra[sapi_index][dntt]; } } /* mg_get_sapi_dntt_state() */ /* +------------------------------------------------------------------------------ | Function : mg_get_sapi_pcomp_state +------------------------------------------------------------------------------ | Description : The procedures informs about the state of a given pcomp on a | given SAPI. | | Parameters : FPAR IN sapi UBYTE, | IN pcomp UBYTE, | IN/OUT stat UBYTE | +------------------------------------------------------------------------------ */ LOCAL void mg_get_sapi_pcomp_state (UBYTE sapi, UBYTE pcomp, UBYTE* stat) { TRACE_FUNCTION( "mg_get_sapi_pcomp_state" ); { UBYTE sapi_index = 0; sndcp_get_sapi_index(sapi, &sapi_index); *stat = sndcp_data->mg.sapi_pcomp_state_ra[sapi_index][pcomp]; } } /* mg_get_sapi_pcomp_state() */ /* +------------------------------------------------------------------------------ | Function : mg_get_sapi_pntt_state +------------------------------------------------------------------------------ | Description : The procedures informs about the state of a given header | compression entity on a given SAPI. | | Parameters : FPAR IN sapi UBYTE, | IN pntt UBYTE, | IN/OUT state UBYTE | +------------------------------------------------------------------------------ */ LOCAL void mg_get_sapi_pntt_state (UBYTE sapi, UBYTE pntt, UBYTE* state) { TRACE_FUNCTION( "mg_get_sapi_pntt_state" ); { UBYTE sapi_index = 0; sndcp_get_sapi_index(sapi, &sapi_index); *state = sndcp_data->mg.sapi_pntt_state_ra[sapi_index][pntt]; } } /* mg_get_sapi_pntt_state() */ /* +------------------------------------------------------------------------------ | Function : mg_check_sense_bitwise +------------------------------------------------------------------------------ | Description : Checks, if "small" is bitwise smaller than or equal to "big" | | Parameters : USHORT small, big, BOOL wrong is set to TRUE, if small > big | +------------------------------------------------------------------------------ */ LOCAL void mg_ushort_sense_bitwise (USHORT small, USHORT big, BOOL* wrong) { UBYTE bit = 0; TRACE_FUNCTION( "mg_check_sense_bitwise" ); *wrong = TRUE; for (bit = 0; bit < 8 * sizeof(USHORT); bit++) { if ((small & (1 << bit)) > (big & (1 << bit))) { return; } } *wrong = FALSE; } /* mg_check_sense_bitwise() */ /* +------------------------------------------------------------------------------ | Function : mg_check_sense_bitwise +------------------------------------------------------------------------------ | Description : Checks, if "small" is bitwise smaller than "big" | | Parameters : UBYTE small, big, BOOL wrong is set to TRUE, if small > big | +------------------------------------------------------------------------------ */ LOCAL void mg_ubyte_sense_bitwise (UBYTE small, UBYTE big, BOOL* wrong) { UBYTE bit = 0; TRACE_FUNCTION( "mg_check_sense_bitwise" ); *wrong = TRUE; for (bit = 0; bit < 8 * sizeof(UBYTE); bit++) { if ((small & (1 << bit)) > (big & (1 << bit))) { return; } } *wrong = FALSE; } /* mg_check_sense_bitwise() */ /* +------------------------------------------------------------------------------ | Function : mg_decode_v42 +------------------------------------------------------------------------------ | Description : decodes the v42 part of given sdu to given xid block | | Parameters : source sdu, | index in sdu, | field index in sdu (sub index in compression fields, | destination xid block, | success ok | +------------------------------------------------------------------------------ */ LOCAL void mg_decode_v42 (T_sdu* sdu, USHORT* index, USHORT* field_index, T_XID_BLOCK* xid_block, BOOL* ok, UBYTE p_bit) { #define CHECK_XID_BUFFER_LEN2 if (*index + *field_index >= ((sdu->l_buf) >> 3)) return USHORT field_length = 0; TRACE_FUNCTION( "mg_decode_v42" ); *ok = FALSE; /* * Set field_index to length of field octet. */ (*field_index)++; CHECK_XID_BUFFER_LEN2; field_length = sdu->buf[*index + *field_index]; /* * NSAPIS parameter and followers omitted? */ if (p_bit == SNDCP_P_BIT_1) { if (field_length == MG_DATA_P_1_NSAPIS_OM) { *ok = TRUE; return; } } else { if (field_length == MG_DATA_P_0_NSAPIS_OM) { *ok = TRUE; return; } } /* * If p bit set to 1, set field_index to dcomp field. */ if (p_bit == SNDCP_P_BIT_1) { (*field_index)++; CHECK_XID_BUFFER_LEN2; xid_block->v42.dcomp = ((USHORT)sdu->buf[*index + *field_index]) >> 4; } /* * Set field_index to MSB of applicable nsapis short. */ (*field_index)++; CHECK_XID_BUFFER_LEN2; xid_block->v42.nsapis = ((USHORT)sdu->buf[*index + *field_index]) << 8; xid_block->v42.nsapis_set = TRUE; /* * Set field_index to LSB of applicable nsapis short. */ (*field_index)++; CHECK_XID_BUFFER_LEN2; xid_block->v42.nsapis += ((USHORT)sdu->buf[*index + *field_index]); /* * P0 parameter and followers omitted? */ if (p_bit == SNDCP_P_BIT_1) { if (field_length == MG_DATA_P_1_P0_OM) { *ok = TRUE; return; } } else { if (field_length == MG_DATA_P_0_P0_OM) { *ok = TRUE; return; } } /* * Set field_index to p0. */ (*field_index)++; CHECK_XID_BUFFER_LEN2; xid_block->v42.p0 = sdu->buf[*index + *field_index]; xid_block->v42.p0_set = TRUE; /* * P1 parameter and followers omitted? */ if (p_bit == SNDCP_P_BIT_1) { if (field_length == MG_DATA_P_1_P1_OM) { *ok =TRUE; return; } } else { if (field_length == MG_DATA_P_0_P1_OM) { *ok =TRUE; return; } } /* * Set field_index to MSB of p1. */ (*field_index)++; CHECK_XID_BUFFER_LEN2; xid_block->v42.p1 = ((USHORT)sdu->buf[*index + *field_index]) << 8; xid_block->v42.p1_set = TRUE; /* * Set field_index to LSB of p1. */ (*field_index)++; CHECK_XID_BUFFER_LEN2; xid_block->v42.p1 += ((USHORT)sdu->buf[*index + *field_index]); /* * P2 parameter and followers omitted? */ if (p_bit == SNDCP_P_BIT_1) { if (field_length == MG_DATA_P_1_P2_OM) { *ok = TRUE; return; } } else { if (field_length == MG_DATA_P_0_P2_OM) { *ok = TRUE; return; } } /* * Set field_index to p2. */ (*field_index)++; CHECK_XID_BUFFER_LEN2; xid_block->v42.p2 = sdu->buf[*index + *field_index]; xid_block->v42.p2_set = TRUE; /* * If length of v42 field is longer than specified, ignore the rest. */ while (*field_index < field_length) { CHECK_XID_BUFFER_LEN2; (*field_index)++; } *ok = TRUE; } /* mg_decode_v42() */ /* +------------------------------------------------------------------------------ | Function : mg_decode_vj +------------------------------------------------------------------------------ | Description : decodes the vj part of given sdu to given xid block | | Parameters : source sdu, | index in sdu, | field index in sdu (sub index in compression fields, | destination xid block, | success ok | +------------------------------------------------------------------------------ */ LOCAL void mg_decode_vj (T_sdu* sdu, USHORT* index, USHORT* field_index, T_XID_BLOCK* xid_block, BOOL* ok, UBYTE p_bit) { #define CHECK_XID_BUFFER_LEN3 if (*index + *field_index >= ((sdu->l_buf) >> 3)) return USHORT field_length = 0; TRACE_FUNCTION( "mg_decode_vj" ); /* * Set field_index to length of field octet. */ (*field_index)++; CHECK_XID_BUFFER_LEN3; field_length = sdu->buf[*index + *field_index]; /* * NSAPIS parameter and followers omitted? */ if (p_bit == SNDCP_P_BIT_1) { if (field_length == MG_HEADER_P_1_NSAPIS_OM) { *ok = TRUE; return; } } else { if (field_length == MG_HEADER_P_0_NSAPIS_OM) { *ok = TRUE; return; } } /* * If p bit set to 1, set field_index to dcomp field. */ if (p_bit == SNDCP_P_BIT_1) { (*field_index)++; CHECK_XID_BUFFER_LEN3; xid_block->vj.pcomp1 = ((USHORT)sdu->buf[*index + *field_index]) >> 4; xid_block->vj.pcomp2 = ((USHORT)sdu->buf[*index + *field_index]) & 0xf; } /* * Set field_index to MSB of applicable nsapis short. */ (*field_index)++; CHECK_XID_BUFFER_LEN3; xid_block->vj.nsapis = ((USHORT)sdu->buf[*index + *field_index]) << 8; xid_block->vj.nsapis_set = TRUE; /* * Set field_index to LSB of applicable nsapis short. */ (*field_index)++; CHECK_XID_BUFFER_LEN3; xid_block->vj.nsapis += ((USHORT)sdu->buf[*index + *field_index]); /* * S0_M_1 parameter omitted? */ if (p_bit == SNDCP_P_BIT_1) { if (field_length == MG_HEADER_P_1_S0_M_1_OM) { *ok = TRUE; return; } } else { if (field_length == MG_HEADER_P_0_S0_M_1_OM) { *ok = TRUE; return; } } /* * Set field_index to "s0 - 1" Parameter */ (*field_index)++; CHECK_XID_BUFFER_LEN3; xid_block->vj.s0_m_1 = sdu->buf[*index + *field_index]; xid_block->vj.s0_m_1_set = TRUE; /* * If length of vj field is longer than specified, ignore the rest. */ while (*field_index < field_length) { CHECK_XID_BUFFER_LEN3; (*field_index)++; } *ok = TRUE; } /* mg_decode_vj() */ /* +------------------------------------------------------------------------------ | Function : mg_detect_mode_clash +------------------------------------------------------------------------------ | Description : Unacknowledged and acknowledged contexts may not share the same | compressor entity. This procdure detects possible violations of that rule. | | Parameters : the set of nsapis given as USHORT bit mask, | violation detected, TRUE if at least 1 acknowledged and 1 | unacknowledged context share the same compressor. | +------------------------------------------------------------------------------ */ LOCAL void mg_detect_mode_clash (USHORT nsapis, BOOL* vio) { UBYTE nsapi = 0; BOOL unack_found = FALSE; BOOL ack_found = FALSE; BOOL ack = FALSE; TRACE_FUNCTION( "mg_detect_mode_clash" ); /* * Find affected nsapis. */ for (nsapi = 0; nsapi < SNDCP_NUMBER_OF_NSAPIS; nsapi++) { if ((nsapis & (1 << nsapi)) > 0) { sndcp_get_nsapi_ack(nsapi, &ack); if (ack) { ack_found = TRUE; } else { unack_found = TRUE; } } } *vio = unack_found && ack_found; } /* mg_detect_mode_clash() */ /* +------------------------------------------------------------------------------ | Function : mg_respond_if_nec +------------------------------------------------------------------------------ | Description : All nsapis connected to the given sapi | that are in state MG_ACT are sent an | SNSM_ACTIVATE_RES. | | Parameters : sapi | +------------------------------------------------------------------------------ */ LOCAL void mg_respond_if_nec (UBYTE sapi) { UBYTE nsapi = 0; UBYTE sapi_index = 0; #ifdef SNDCP_UPM_INCLUDED BOOL ack = FALSE; #endif /* SNDCP_UPM_INCLUDED */ TRACE_FUNCTION( "mg_respond_if_nec" ); sndcp_get_sapi_index(sapi, &sapi_index); for (nsapi = 0; nsapi < SNDCP_NUMBER_OF_NSAPIS; nsapi++) { USHORT nsapi_state = MG_IDLE; USHORT sapi_state = MG_IDLE; UBYTE local_sapi = 0; sndcp_get_nsapi_state(nsapi, &nsapi_state); sndcp_get_nsapi_sapi(nsapi, &local_sapi); sndcp_get_sapi_state(local_sapi, &sapi_state); if (((nsapi_state & MG_ACT) > 0) && ((sapi_state & MG_XID) == 0) && ((sapi_state & MG_EST) == 0) && (local_sapi == sapi)) { /* * Open DTI connection. */ #ifndef SNDCP_UPM_INCLUDED mg_dti_open(nsapi); #else sndcp_get_nsapi_ack(nsapi, &ack); if (ack) { nu_ready_ind_if_nec(nsapi); } else { nu_unitready_ind_if_nec(nsapi); } #endif mg_send_snsm_activate_res(nsapi); /* * Set nsapi state to MG_IDLE. */ sndcp_unset_nsapi_state (nsapi, MG_ACT); } if (((nsapi_state & MG_DEACT) > 0) && ((sapi_state & MG_XID) == 0) && ((sapi_state & MG_REL) == 0) && (local_sapi == sapi)) { #ifdef SNDCP_UPM_INCLUDED PALLOC(snsm_deactivate_res, SN_DEACTIVATE_CNF); #else PALLOC(snsm_deactivate_res, SNSM_DEACTIVATE_RES); #endif /*#ifdef SNDCP_UPM_INCLUDED*/ /* * Now the NSAPI is not in use anymore: */ sndcp_set_nsapi_used(nsapi, FALSE); sndcp_set_nsapi_ack(nsapi, FALSE); snsm_deactivate_res->nsapi = nsapi; sndcp_unset_nsapi_state(nsapi, MG_DEACT); #ifdef SNDCP_UPM_INCLUDED PSEND(hCommUPM, snsm_deactivate_res); #else PSEND(hCommSM, snsm_deactivate_res); #endif /*#ifdef SNDCP_UPM_INCLUDED*/ } } } /* mg_respond_if_nec */ /* +------------------------------------------------------------------------------ | Function : mg_set_ntt_comp +------------------------------------------------------------------------------ | Description : Sets ntt and comp values acc. to req_xid_block. | | Parameters : UBYTE sapi, BOOL is this a renegotiation? | +------------------------------------------------------------------------------ */ LOCAL void mg_set_ntt_comp (UBYTE sapi) { UBYTE sapi_index = 0; UBYTE nsapi = 0; TRACE_FUNCTION( "mg_set_ntt_comp" ); sndcp_get_sapi_index(sapi, &sapi_index); if (sndcp_data->mg.req_xid_block[sapi_index].v42.is_set) { mg_set_sapi_dntt_state(sapi, sndcp_data->mg.req_xid_block[sapi_index].v42.ntt, MG_SELECTED); for (nsapi = 0; nsapi < SNDCP_NUMBER_OF_NSAPIS; nsapi++) { if ((sndcp_data->mg.req_xid_block[sapi_index].v42.nsapis & (1 << nsapi)) > 0) { mg_set_sapi_dntt_nsapi(sapi, sndcp_data->mg.req_xid_block[sapi_index].v42.ntt, nsapi, TRUE); } } mg_set_sapi_dcomp_state(sapi, sndcp_data->mg.req_xid_block[sapi_index].v42.dcomp, MG_SELECTED); mg_set_sapi_dcomp_dntt(sapi, sndcp_data->mg.req_xid_block[sapi_index].v42.dcomp, sndcp_data->mg.req_xid_block[sapi_index].v42.ntt); } if (sndcp_data->mg.req_xid_block[sapi_index].vj.is_set) { mg_set_sapi_pntt_state(sapi, sndcp_data->mg.req_xid_block[sapi_index].vj.ntt, MG_SELECTED); for (nsapi = 0; nsapi < SNDCP_NUMBER_OF_NSAPIS; nsapi++) { if ((sndcp_data->mg.req_xid_block[sapi_index].vj.nsapis & (1 << nsapi)) > 0) { mg_set_sapi_pntt_nsapi(sapi, sndcp_data->mg.req_xid_block[sapi_index].vj.ntt, nsapi, TRUE); } } mg_set_sapi_pcomp_state(sapi, sndcp_data->mg.req_xid_block[sapi_index].vj.pcomp1, MG_SELECTED); mg_set_sapi_pcomp_state(sapi, sndcp_data->mg.req_xid_block[sapi_index].vj.pcomp2, MG_SELECTED); mg_set_sapi_pcomp_pntt(sapi, sndcp_data->mg.req_xid_block[sapi_index].vj.pcomp1, sndcp_data->mg.req_xid_block[sapi_index].vj.ntt); mg_set_sapi_pcomp_pntt(sapi, sndcp_data->mg.req_xid_block[sapi_index].vj.pcomp2, sndcp_data->mg.req_xid_block[sapi_index].vj.ntt); } } /* mg_set_ntt_comp() */ /* +------------------------------------------------------------------------------ | Function : mg_set_sapi_dntt_nsapi +------------------------------------------------------------------------------ | Description : The procedure stores the info that a given nsapi uses a given | dntt on a given sapi. | | Parameters : FPAR IN sapi UBYTE, | IN dntt UBYTE, | IN nsapi UBYTE, | IN used BOOL | +------------------------------------------------------------------------------ */ LOCAL void mg_set_sapi_dntt_nsapi (UBYTE sapi, UBYTE dntt, UBYTE nsapi, BOOL used) { TRACE_FUNCTION( "mg_set_sapi_dntt_nsapi" ); { UBYTE sapi_index = 0; sndcp_get_sapi_index(sapi, &sapi_index); sndcp_data->mg.sapi_dntt_nsapi_set_ra[sapi_index][dntt][nsapi] = used; } } /* mg_set_sapi_dntt_nsapi() */ /* +------------------------------------------------------------------------------ | Function : mg_set_sapi_dcomp_state +------------------------------------------------------------------------------ | Description : The procedures sets the state of a given dcomp on a given SAPI. | | Parameters : FPAR IN sapi UBYTE, | IN dcomp UBYTE, | IN stat UBYTE | +------------------------------------------------------------------------------ */ LOCAL void mg_set_sapi_dcomp_state (UBYTE sapi, UBYTE dcomp, UBYTE stat) { TRACE_FUNCTION( "mg_set_sapi_dcomp_state" ); { UBYTE sapi_index = 0; sndcp_get_sapi_index(sapi, &sapi_index); sndcp_data->mg.sapi_dcomp_state_ra[sapi_index][dcomp] = stat; } } /* mg_set_sapi_dcomp_state() */ /* +------------------------------------------------------------------------------ | Function : mg_set_sapi_dcomp_dntt +------------------------------------------------------------------------------ | Description : The procedures sets the dntt assigned to a given dcomp | for a given sapi. | | Parameters : FPAR IN sapi UBYTE, | IN dcomp UBYTE, | IN dntt UBYTE | +------------------------------------------------------------------------------ */ LOCAL void mg_set_sapi_dcomp_dntt (UBYTE sapi, UBYTE dcomp, UBYTE dntt) { TRACE_FUNCTION( "mg_set_sapi_dcomp_dntt" ); { UBYTE sapi_index = 0; sndcp_get_sapi_index(sapi, &sapi_index); sndcp_data->mg.sapi_dcomp_dntt_ra[sapi_index][dcomp] = dntt; } } /* mg_set_sapi_dcomp_dntt() */ /* +------------------------------------------------------------------------------ | Function : mg_set_sapi_dntt_rej +------------------------------------------------------------------------------ | Description : The procedures stores if a given data | compression entity on a given SAPI is to be rejected in | LL_XID_REQ because it cannot be set up. | | Parameters : FPAR IN sapi UBYTE, | IN dntt UBYTE, | IN rej BOOL | +------------------------------------------------------------------------------ */ LOCAL void mg_set_sapi_dntt_rej (UBYTE sapi, UBYTE dntt, BOOL rej) { TRACE_FUNCTION( "mg_set_sapi_dntt_rej" ); { UBYTE sapi_index = 0; sndcp_get_sapi_index(sapi, &sapi_index); sndcp_data->mg.sapi_dntt_rej_ra[sapi_index][dntt] = rej; } } /* mg_set_sapi_dntt_rej() */ /* +------------------------------------------------------------------------------ | Function : mg_set_sapi_dntt_state +------------------------------------------------------------------------------ | Description : The procedures sets the state of a given data | compression entity on a given SAPI. | | Parameters : FPAR IN sapi UBYTE, | IN dntt UBYTE, | IN state UBYTE | Note : sapi dntt rej will be set ti FALSE if state is UNASSIGNED | +------------------------------------------------------------------------------ */ LOCAL void mg_set_sapi_dntt_state (UBYTE sapi, UBYTE dntt, UBYTE state) { TRACE_FUNCTION( "mg_set_sapi_dntt_state" ); { UBYTE sapi_index = 0; sndcp_get_sapi_index(sapi, &sapi_index); sndcp_data->mg.sapi_dntt_state_ra[sapi_index][dntt] = state; if (state == MG_UNASSIGNED) { mg_set_sapi_dntt_rej(sapi, dntt, FALSE); } } } /* mg_set_sapi_dntt_state() */ /* +------------------------------------------------------------------------------ | Function : mg_set_sapi_pntt_nsapi +------------------------------------------------------------------------------ | Description : The procedure stores the info that a given nsapi uses a given | pntt on a given sapi. | | Parameters : FPAR IN sapi UBYTE, | IN pntt UBYTE, | IN nsapi UBYTE, | IN used BOOL | +------------------------------------------------------------------------------ */ LOCAL void mg_set_sapi_pntt_nsapi (UBYTE sapi, UBYTE pntt, UBYTE nsapi, BOOL used) { TRACE_FUNCTION( "mg_set_sapi_pntt_nsapi" ); { UBYTE sapi_index = 0; sndcp_get_sapi_index(sapi, &sapi_index); sndcp_data->mg.sapi_pntt_nsapi_set_ra[sapi_index][pntt][nsapi] = used; } } /* mg_set_sapi_pntt_nsapi() */ /* +------------------------------------------------------------------------------ | Function : mg_set_sapi_pcomp_state +------------------------------------------------------------------------------ | Description : The procedures sets the state of a given pcomp on a given SAPI. | | Parameters : FPAR IN sapi UBYTE, | IN pcomp UBYTE, | IN stat UBYTE | +------------------------------------------------------------------------------ */ LOCAL void mg_set_sapi_pcomp_state (UBYTE sapi, UBYTE pcomp, UBYTE stat) { TRACE_FUNCTION( "mg_set_sapi_pcomp_state" ); { UBYTE sapi_index = 0; sndcp_get_sapi_index(sapi, &sapi_index); sndcp_data->mg.sapi_pcomp_state_ra[sapi_index][pcomp] = stat; } } /* mg_set_sapi_pcomp_state() */ /* +------------------------------------------------------------------------------ | Function : mg_set_sapi_pcomp_pntt +------------------------------------------------------------------------------ | Description : The procedures sets the pntt assigned to a given pcomp | for a given sapi. | | Parameters : FPAR IN sapi UBYTE, | IN pcomp UBYTE, | IN pntt UBYTE | +------------------------------------------------------------------------------ */ LOCAL void mg_set_sapi_pcomp_pntt (UBYTE sapi, UBYTE pcomp, UBYTE pntt) { TRACE_FUNCTION( "mg_set_sapi_pcomp_pntt" ); { UBYTE sapi_index = 0; sndcp_get_sapi_index(sapi, &sapi_index); sndcp_data->mg.sapi_pcomp_pntt_ra[sapi_index][pcomp] = pntt; } } /* mg_get_sapi_pcomp_pntt() */ /* +------------------------------------------------------------------------------ | Function : mg_set_sapi_pntt_rej +------------------------------------------------------------------------------ | Description : The procedures stores if a given data | compression entity on a given SAPI is to be rejected in | LL_XID_REQ because it cannot be set up. | | Parameters : FPAR IN sapi UBYTE, | IN pntt UBYTE, | IN rej BOOL | +------------------------------------------------------------------------------ */ LOCAL void mg_set_sapi_pntt_rej (UBYTE sapi, UBYTE pntt, BOOL rej) { TRACE_FUNCTION( "mg_set_sapi_pntt_rej" ); { UBYTE sapi_index = 0; sndcp_get_sapi_index(sapi, &sapi_index); sndcp_data->mg.sapi_pntt_rej_ra[sapi_index][pntt] = rej; } } /* mg_set_sapi_pntt_rej() */ /* +------------------------------------------------------------------------------ | Function : mg_set_sapi_pntt_state +------------------------------------------------------------------------------ | Description : The procedures sets the state of a given header | compression entity on a given SAPI. | | Parameters : FPAR IN sapi UBYTE, | IN pntt UBYTE, | IN state UBYTE | Note : sapi pntt rej will be set ti FALSE if state is UNASSIGNED | +------------------------------------------------------------------------------ */ LOCAL void mg_set_sapi_pntt_state (UBYTE sapi, UBYTE pntt, UBYTE state) { TRACE_FUNCTION( "mg_set_sapi_pntt_state" ); { UBYTE sapi_index = 0; sndcp_get_sapi_index(sapi, &sapi_index); sndcp_data->mg.sapi_pntt_state_ra[sapi_index][pntt] = state; if (state == MG_UNASSIGNED) { mg_set_sapi_pntt_rej(sapi, pntt, FALSE); } } } /* mg_set_sapi_pntt_state() */ #ifndef NCONFIG /* +------------------------------------------------------------------------------ | Function : mg_config_delay +------------------------------------------------------------------------------ | Description : after config prim DELAY each new context activation will be | computed with a delay. | | Parameters : delay in milliseconds | +------------------------------------------------------------------------------ */ GLOBAL void mg_config_delay (USHORT millis) { TRACE_FUNCTION("mg_config_delay"); sndcp_data->millis = millis; } /* mg_config_delay() */ #endif /* +------------------------------------------------------------------------------ | Function : mg_reset_compressors +------------------------------------------------------------------------------ | Description : All compressors used by this nsapi are reset. | | Parameters : nsapi | +------------------------------------------------------------------------------ */ GLOBAL void mg_reset_compressors (UBYTE nsapi) { BOOL compressed = FALSE; TRACE_FUNCTION( "mg_reset_compressors" ); sndcp_is_nsapi_data_compressed(nsapi, &compressed); if (compressed) { /* * Must be added when data compression is added. */ } sndcp_is_nsapi_header_compressed(nsapi, &compressed); if (compressed) { UBYTE sapi = 0; UBYTE sapi_index = 0; /* * This is implementation dependent and only works as long as only 1 * header compressor is used in cia service. */ sndcp_get_nsapi_sapi(nsapi, &sapi); sndcp_get_sapi_index(sapi, &sapi_index); sig_mg_cia_new_xid(&sndcp_data->mg.cur_xid_block[sapi_index]); } } /* mg_reset_compressors() */ /* +------------------------------------------------------------------------------ | Function : mg_reset_comp_ack +------------------------------------------------------------------------------ | Description : all compression entities using | acknowledged peer-to-peer LLC operation on this SAPI are reset. | | Parameters : sapi | +------------------------------------------------------------------------------ */ GLOBAL void mg_reset_comp_ack (UBYTE sapi) { UBYTE nsapi = 0; TRACE_FUNCTION( "mg_reset_comp_ack" ); /* * All nsapis at this sapi that use ack mode reset their compressors. */ for (nsapi = 0; nsapi < SNDCP_NUMBER_OF_NSAPIS; nsapi ++) { UBYTE s = 0; BOOL ack = FALSE; BOOL used = FALSE; sndcp_is_nsapi_used(nsapi, &used); if (!used) { continue; } sndcp_get_nsapi_sapi(nsapi, &s); sndcp_get_nsapi_ack(nsapi, &ack); if (ack && s == sapi) { mg_reset_compressors(nsapi); } } /* for all nsapis */ } /* mg_reset_comp_ack() */ /* +------------------------------------------------------------------------------ | Function : mg_reset_states_n_rej +------------------------------------------------------------------------------ | Description : Resets all states for ntts and p/dcomp to "unassigned". | Resets the arrays with information on rejcted entities. | | Parameters : index of the affected sapi | +------------------------------------------------------------------------------ */ GLOBAL void mg_reset_states_n_rej (UBYTE sapi_index) { UBYTE ntt = 0; UBYTE nsapi = 0; UBYTE dcomp = 0; UBYTE pcomp = 0; TRACE_FUNCTION( "mg_reset_states_n_rej" ); for (ntt = 0; ntt < MG_MAX_ENTITIES; ntt++) { sndcp_data->mg.sapi_dntt_state_ra[sapi_index][ntt] = MG_UNASSIGNED; sndcp_data->mg.sapi_pntt_state_ra[sapi_index][ntt] = MG_UNASSIGNED; for (nsapi = 0; nsapi < SNDCP_NUMBER_OF_NSAPIS; nsapi++) { sndcp_data->mg.sapi_dntt_nsapi_set_ra[sapi_index][ntt][nsapi] = FALSE; sndcp_data->mg.sapi_pntt_nsapi_set_ra[sapi_index][ntt][nsapi] = FALSE; } sndcp_data->mg.sapi_dntt_rej_ra[sapi_index][ntt] = FALSE; sndcp_data->mg.sapi_pntt_rej_ra[sapi_index][ntt] = FALSE; } for (dcomp = 0; dcomp < MG_MAX_DCOMP; dcomp++) { sndcp_data->mg.sapi_dcomp_state_ra[sapi_index][dcomp] = MG_UNASSIGNED; } for (pcomp = 0; pcomp < MG_MAX_PCOMP; pcomp++) { sndcp_data->mg.sapi_pcomp_state_ra[sapi_index][pcomp] = MG_UNASSIGNED; } /* * sapi_dcomp_dntt_ra, sapi_pcomp_pntt_ra not initialized. */ } /* mg_reset_states_n_rej() */ /* +------------------------------------------------------------------------------ | Function : mg_set_xid_nsapis +------------------------------------------------------------------------------ | Description : AN LL_XID_IND has delivered a desired set of nsapis for | a V42.bis or VJ compressor entity. Now this is compared to a possibly | already existing set of nsapis connected to the given entity. | Also the rules in GSM 4.65, 6.8.x are checked. | | Parameters : a flag telling if we work on V42 or VanJacobson 'nsapis': | MG_XID_V42_NSAPIS or MG_XID_VJ_NSAPIS. | affected sapi, | +------------------------------------------------------------------------------ */ LOCAL void mg_set_xid_nsapis (UBYTE sapi, UBYTE p_type) { USHORT* cur_nsapis = 0; USHORT* ind_nsapis = 0; USHORT* res_nsapis = 0; BOOL* ind_nsapis_set = NULL; UBYTE sapi_index = 0; UBYTE* p_bit = NULL; UBYTE ntt_state = MG_UNASSIGNED; U8 nsapi = 0; U8 s0_m_1_min = 0; TRACE_FUNCTION( "mg_set_xid_nsapis" ); sndcp_get_sapi_index(sapi, &sapi_index); /* * V42.bis or VanJacobson? */ if (p_type == MG_XID_V42_NSAPIS) { cur_nsapis = &(sndcp_data->mg.cur_xid_block[sapi_index].v42.nsapis); ind_nsapis = &(sndcp_data->mg.ind_xid_block[sapi_index].v42.nsapis); res_nsapis = &(sndcp_data->mg.res_xid_block[sapi_index].v42.nsapis); ind_nsapis_set = &(sndcp_data->mg.ind_xid_block[sapi_index].v42.nsapis_set); p_bit = &(sndcp_data->mg.ind_xid_block[sapi_index].v42.p_bit); *res_nsapis = 0; /* * Only those nsapis will be set in the response for which the user * requested compression. * Note: te other params are not yet set, must be implemented later. */ sndcp_data->mg.res_xid_block[sapi_index].v42.nsapis_set = FALSE; for (nsapi = 0; nsapi < SNDCP_NUMBER_OF_NSAPIS; nsapi++) { if ((((1 << nsapi) & sndcp_data->mg.user_xid_block[nsapi].v42.nsapis) > 0) && (((1 << nsapi) & sndcp_data->mg.ind_xid_block[sapi_index].v42.nsapis) > 0)) { *res_nsapis |= (1 << nsapi); sndcp_data->mg.res_xid_block[sapi_index].v42.nsapis_set = TRUE; } } /* for nsapi */ } else { cur_nsapis = &(sndcp_data->mg.cur_xid_block[sapi_index].vj.nsapis); ind_nsapis = &(sndcp_data->mg.ind_xid_block[sapi_index].vj.nsapis); res_nsapis = &(sndcp_data->mg.res_xid_block[sapi_index].vj.nsapis); ind_nsapis_set = &(sndcp_data->mg.ind_xid_block[sapi_index].vj.nsapis_set); p_bit = &(sndcp_data->mg.ind_xid_block[sapi_index].vj.p_bit); *res_nsapis = 0; /* * Only those nsapis will be set in the response for which the user * requested compression. * In the same loop we set the s0_m_1 to the minimum of * the indicated value and the values requested by the user. * Also the direction is set to the minimum of all requested * directions. */ if (sndcp_data->mg.ind_xid_block[sapi_index].vj.s0_m_1 > 0) { s0_m_1_min = sndcp_data->mg.ind_xid_block[sapi_index].vj.s0_m_1; } else if (sndcp_data->mg.cur_xid_block[sapi_index].vj.s0_m_1 > 0) { s0_m_1_min = sndcp_data->mg.cur_xid_block[sapi_index].vj.s0_m_1; } else { s0_m_1_min = SNDCP_VJ_DEFAULT_S0_M_1; } #ifdef SNDCP_UPM_INCLUDED sndcp_data->mg.res_xid_block[sapi_index].vj.direction = NAS_HCOMP_BOTH_DIRECT; #else sndcp_data->mg.res_xid_block[sapi_index].vj.direction = SNSM_COMP_BOTH_DIRECT; #endif sndcp_data->mg.res_xid_block[sapi_index].vj.nsapis_set = FALSE; for (nsapi = 0; nsapi < SNDCP_NUMBER_OF_NSAPIS; nsapi++) { if (((1 << nsapi) & sndcp_data->mg.user_xid_block[nsapi].vj.nsapis) > 0 && (((1 << nsapi) & sndcp_data->mg.ind_xid_block[sapi_index].vj.nsapis) > 0)) { *res_nsapis |= (1 << nsapi); sndcp_data->mg.res_xid_block[sapi_index].vj.nsapis_set = TRUE; if (sndcp_data->mg.user_xid_block[nsapi].vj.s0_m_1 < s0_m_1_min) { s0_m_1_min = sndcp_data->mg.user_xid_block[nsapi].vj.s0_m_1; } sndcp_data->mg.res_xid_block[sapi_index].vj.direction &= sndcp_data->mg.user_xid_block[nsapi].vj.direction; } } /* for nsapi */ sndcp_data->mg.res_xid_block[sapi_index].vj.s0_m_1 = s0_m_1_min; if (s0_m_1_min > 0) { sndcp_data->mg.res_xid_block[sapi_index].vj.s0_m_1_set = TRUE; } else { sndcp_data->mg.res_xid_block[sapi_index].vj.direction = 0; } } /* * Rules in GSM 4.65, 6.8.1: acknowledged and unacknowlegded contexts may not * share the same compressor. If that is demanded by the indication, reset * nsapis parameter to the ones currently used. */ if (*ind_nsapis_set && *ind_nsapis > 0) { BOOL vio = FALSE; mg_detect_mode_clash(*ind_nsapis, &vio); if (!vio) { /* * Modes are the same, set cur to res. */ *cur_nsapis = *res_nsapis; } else { *res_nsapis = *cur_nsapis; } } /* * Also from 6.8.3: If an unassigned entity number is included with the * p bit set to 0, then the Applicable NSAPIs field shall be set to 0. */ if (p_type == MG_XID_V42_NSAPIS) { mg_get_sapi_dntt_state (sapi, sndcp_data->mg.ind_xid_block[sapi_index].v42.ntt, &ntt_state); } else { mg_get_sapi_pntt_state (sapi, sndcp_data->mg.ind_xid_block[sapi_index].vj.ntt, &ntt_state); } if (ntt_state == MG_UNASSIGNED && *p_bit == 0) { *cur_nsapis = 0; *res_nsapis = 0; } } /* mg_set_xid_nsapis() */ /*==== PUBLIC FUNCTIONS =====================================================*/ /* +------------------------------------------------------------------------------ | Function : mg_check_cnf_xid +------------------------------------------------------------------------------ | Description : The confirmation of a requested XID negotiation has been | received. The answer is now checked. | A main issue is the comparison with the service variable | req_xid_block which holds the requested xid block sent to the | network. | Detected errors: | - SNDCP version number not correct | - incorrect entity number (must be proposed one) | - incorrect sense of negotiation for each parameter (down mainly, | NSAPI down bitwise) | - an entity is included in the cnf that was not requested, does not exist | Not checked: | - out of range value of parameters (must be in range if sense ofnegotiation was right. | - parameters with duplicated instances. | If one of these errors occurs ret is set to MG_XID_BAD_CONTENT, else | MG_XID_OK. | | Parameters : ret, affected sapi | +------------------------------------------------------------------------------ */ GLOBAL void mg_check_cnf_xid (UBYTE* ret, UBYTE sapi) { UBYTE sapi_index = 0; BOOL wrong = FALSE; TRACE_FUNCTION( "mg_check_cnf_xid" ); sndcp_get_sapi_index(sapi, &sapi_index); *ret = MG_XID_BAD_CONTENT; /* * Check SNDCP version. */ if (sndcp_data->mg.cnf_xid_block[sapi_index].version_set) { if (sndcp_data->mg.cnf_xid_block[sapi_index].version != SNDCP_XID_VERSION) { return; } } /* * If an entity is included that has not been requested / does not exist: * bad content! */ if (sndcp_data->mg.cnf_xid_block[sapi_index].v42.is_set && ! sndcp_data->mg.req_xid_block[sapi_index].v42.is_set && ! sndcp_data->mg.cur_xid_block[sapi_index].v42.is_set) { return; } if (sndcp_data->mg.cnf_xid_block[sapi_index].vj.is_set && ! sndcp_data->mg.req_xid_block[sapi_index].vj.is_set && ! sndcp_data->mg.cur_xid_block[sapi_index].vj.is_set) { return; } /* * Check V42 parameters, if they are set. */ if (sndcp_data->mg.cnf_xid_block[sapi_index].v42.is_set) { if (sndcp_data->mg.cnf_xid_block[sapi_index].v42.p_bit == 1) { return; } if (sndcp_data->mg.cnf_xid_block[sapi_index].v42.ntt != sndcp_data->mg.req_xid_block[sapi_index].v42.ntt) { return; } /* * Sense of negotiation. If cnf value has been set, but req has not been * set then cnf value will be compared with cur value. This * is not applied to "applicable nsapis". */ if (sndcp_data->mg.cnf_xid_block[sapi_index].v42.nsapis_set) { if (sndcp_data->mg.req_xid_block[sapi_index].v42.nsapis_set) { mg_ushort_sense_bitwise (sndcp_data->mg.cnf_xid_block[sapi_index].v42.nsapis, sndcp_data->mg.req_xid_block[sapi_index].v42.nsapis, &wrong); } if (wrong) { return; } } if (sndcp_data->mg.cnf_xid_block[sapi_index].v42.p0_set) { if (sndcp_data->mg.req_xid_block[sapi_index].v42.p0_set) { mg_ubyte_sense_bitwise(sndcp_data->mg.cnf_xid_block[sapi_index].v42.p0, sndcp_data->mg.req_xid_block[sapi_index].v42.p0, &wrong); } else { mg_ubyte_sense_bitwise(sndcp_data->mg.cnf_xid_block[sapi_index].v42.p0, sndcp_data->mg.cur_xid_block[sapi_index].v42.p0, &wrong); } if (wrong) { return; } } if (sndcp_data->mg.cnf_xid_block[sapi_index].v42.p1_set) { if (sndcp_data->mg.req_xid_block[sapi_index].v42.p1_set) { if (sndcp_data->mg.cnf_xid_block[sapi_index].v42.p1 > sndcp_data->mg.req_xid_block[sapi_index].v42.p1) { return; } } else { if (sndcp_data->mg.cnf_xid_block[sapi_index].v42.p1 > sndcp_data->mg.cur_xid_block[sapi_index].v42.p1) { return; } } } if (sndcp_data->mg.cnf_xid_block[sapi_index].v42.p2_set) { if (sndcp_data->mg.req_xid_block[sapi_index].v42.p2_set) { if (sndcp_data->mg.cnf_xid_block[sapi_index].v42.p2 > sndcp_data->mg.req_xid_block[sapi_index].v42.p2) { return; } } else { if (sndcp_data->mg.cnf_xid_block[sapi_index].v42.p2 > sndcp_data->mg.cur_xid_block[sapi_index].v42.p2) { return; } } } } /* * Check VJ parameters, if they are set. */ if (sndcp_data->mg.cnf_xid_block[sapi_index].vj.is_set) { if (sndcp_data->mg.cnf_xid_block[sapi_index].vj.p_bit == 1) { return; } if (sndcp_data->mg.cnf_xid_block[sapi_index].vj.ntt != sndcp_data->mg.req_xid_block[sapi_index].vj.ntt) { return; } /* * Sense of negotiation. */ if (sndcp_data->mg.cnf_xid_block[sapi_index].vj.nsapis_set) { if (sndcp_data->mg.req_xid_block[sapi_index].vj.nsapis_set) { mg_ushort_sense_bitwise(sndcp_data->mg.cnf_xid_block[sapi_index].vj.nsapis, sndcp_data->mg.req_xid_block[sapi_index].vj.nsapis, &wrong); } if (wrong) { return; } } if (sndcp_data->mg.cnf_xid_block[sapi_index].vj.s0_m_1_set) { if (sndcp_data->mg.req_xid_block[sapi_index].vj.s0_m_1_set) { if (sndcp_data->mg.cnf_xid_block[sapi_index].vj.s0_m_1 > sndcp_data->mg.req_xid_block[sapi_index].vj.s0_m_1) { return; } } else { if (sndcp_data->mg.cnf_xid_block[sapi_index].vj.s0_m_1 > sndcp_data->mg.cur_xid_block[sapi_index].vj.s0_m_1) { return; } } } } *ret = MG_XID_OK; } /* mg_check_cnf_xid() */ /* +------------------------------------------------------------------------------ | Function : mg_check_ind_xid +------------------------------------------------------------------------------ | Description : Service variable ind_xid_block holds the xid block indicated | by the peer. The ind_xid_block is now checked: (from 4.65 6.8.2). | Criterium 1: | If the indicated ntt is already used and pcomp or dcomp values are different, | ret is set to MG_XID_BAD_CONTENT. | Criterium 2: | If the indicated algorithm type is already used and pcomp or dcomp values | are different, ret is set to MG_XID_BAD_CONTENT. | | Note: implementation dependent: if data compression is proposed, it will | be rejected. | | Otherwise ret is set to MG_XID_OK. | Parameters : ret, affected sapi | +------------------------------------------------------------------------------ */ GLOBAL void mg_check_ind_xid (UBYTE* ret, UBYTE sapi) { UBYTE sapi_index = 0; UBYTE status = MG_UNASSIGNED; TRACE_FUNCTION( "mg_check_ind_xid" ); sndcp_get_sapi_index(sapi, &sapi_index); *ret = MG_XID_OK; /* * Check criterium 1. */ if (sndcp_data->mg.ind_xid_block[sapi_index].v42.is_set && sndcp_data->mg.ind_xid_block[sapi_index].v42.p_bit == SNDCP_P_BIT_1) { mg_get_sapi_dntt_state (sapi, sndcp_data->mg.ind_xid_block[sapi_index].v42.ntt, &status); if (status == MG_ASSIGNED) { /* * Entity already used. DCOMP values differ? */ mg_get_sapi_dcomp_state (sapi, sndcp_data->mg.ind_xid_block[sapi_index].v42.dcomp, &status); if (status != MG_ASSIGNED) { /* * The indicated dcomp is not assigned. Error. */ mg_set_sapi_dntt_rej(sapi, sndcp_data->mg.ind_xid_block[sapi_index].v42.ntt, TRUE); *ret = MG_XID_BAD_CONTENT; } else { UBYTE dntt = 0; mg_get_sapi_dcomp_dntt (sapi, sndcp_data->mg.ind_xid_block[sapi_index].v42.dcomp, &dntt); if (dntt != sndcp_data->mg.ind_xid_block[sapi_index].v42.ntt) { /* * Dcomp values differ, Error. */ mg_set_sapi_dntt_rej(sapi, sndcp_data->mg.ind_xid_block[sapi_index].v42.ntt, TRUE); *ret = MG_XID_BAD_CONTENT; } } } } if (sndcp_data->mg.ind_xid_block[sapi_index].vj.is_set && sndcp_data->mg.ind_xid_block[sapi_index].vj.p_bit == SNDCP_P_BIT_1) { mg_get_sapi_pntt_state (sapi, sndcp_data->mg.ind_xid_block[sapi_index].vj.ntt, &status); if (status == MG_ASSIGNED) { /* * Entity already used. PCOMP values differ? */ /* * PCOMP 1. */ mg_get_sapi_pcomp_state (sapi, sndcp_data->mg.ind_xid_block[sapi_index].vj.pcomp1, &status); if (status != MG_ASSIGNED) { /* * The indicated pcomp is not assigned. Error. */ mg_set_sapi_pntt_rej(sapi, sndcp_data->mg.ind_xid_block[sapi_index].vj.ntt, TRUE); *ret = MG_XID_BAD_CONTENT; } else { UBYTE pntt = 0; mg_get_sapi_pcomp_pntt (sapi, sndcp_data->mg.ind_xid_block[sapi_index].vj.pcomp1, &pntt); if (pntt != sndcp_data->mg.ind_xid_block[sapi_index].vj.ntt) { /* * Pcomp values differ, Error. */ mg_set_sapi_pntt_rej(sapi, sndcp_data->mg.ind_xid_block[sapi_index].vj.ntt, TRUE); *ret = MG_XID_BAD_CONTENT; } } /* * PCOMP 2. */ mg_get_sapi_pcomp_state (sapi, sndcp_data->mg.ind_xid_block[sapi_index].vj.pcomp1, &status); if (status != MG_ASSIGNED) { /* * The indicated pcomp is not assigned. Error. */ mg_set_sapi_pntt_rej(sapi, sndcp_data->mg.ind_xid_block[sapi_index].vj.ntt, TRUE); *ret = MG_XID_BAD_CONTENT; } else { UBYTE pntt = 0; mg_get_sapi_pcomp_pntt (sapi, sndcp_data->mg.ind_xid_block[sapi_index].vj.pcomp1, &pntt); if (pntt != sndcp_data->mg.ind_xid_block[sapi_index].vj.ntt) { /* * Dcomp values differ, Error. */ mg_set_sapi_pntt_rej(sapi, sndcp_data->mg.ind_xid_block[sapi_index].vj.ntt, TRUE); *ret = MG_XID_BAD_CONTENT; } } } } /* * Check criterium 2. * Since in the current implementation there is only SNDCP_XID_VJ and * SNDCP_XID_V42, and only 1 instance of each, * it will be sufficient to compare the proposed values for pcomp/dcomp * with the ones in cur_xid_block. * An error may only occur if cur and ind are set. */ if (sndcp_data->mg.ind_xid_block[sapi_index].v42.is_set && sndcp_data->mg.cur_xid_block[sapi_index].v42.is_set && sndcp_data->mg.ind_xid_block[sapi_index].v42.p_bit == SNDCP_P_BIT_1) { if (sndcp_data->mg.ind_xid_block[sapi_index].v42.dcomp != sndcp_data->mg.cur_xid_block[sapi_index].v42.dcomp) { mg_set_sapi_dntt_rej(sapi, sndcp_data->mg.ind_xid_block[sapi_index].v42.ntt, TRUE); *ret = MG_XID_BAD_CONTENT; } } if (sndcp_data->mg.ind_xid_block[sapi_index].vj.is_set && sndcp_data->mg.cur_xid_block[sapi_index].vj.is_set && sndcp_data->mg.ind_xid_block[sapi_index].v42.p_bit == SNDCP_P_BIT_1) { if (sndcp_data->mg.ind_xid_block[sapi_index].vj.pcomp1 != sndcp_data->mg.cur_xid_block[sapi_index].vj.pcomp1) { mg_set_sapi_pntt_rej(sapi, sndcp_data->mg.ind_xid_block[sapi_index].vj.ntt, TRUE); *ret = MG_XID_BAD_CONTENT; } if (sndcp_data->mg.ind_xid_block[sapi_index].vj.pcomp2 != sndcp_data->mg.cur_xid_block[sapi_index].vj.pcomp2) { mg_set_sapi_pntt_rej(sapi, sndcp_data->mg.ind_xid_block[sapi_index].vj.ntt, TRUE); *ret = MG_XID_BAD_CONTENT; } } #ifndef TI_PS_FF_V42BIS /* * Implementation dependent: If data compression is proposed, reject it! */ if (sndcp_data->mg.ind_xid_block[sapi_index].v42.is_set) { mg_set_sapi_dntt_rej(sapi, sndcp_data->mg.ind_xid_block[sapi_index].v42.ntt, TRUE); } #endif /* !TI_PS_FF_V42BIS */ } /* mg_check_ind_xid() */ /* +------------------------------------------------------------------------------ | Function : mg_clean_xid +------------------------------------------------------------------------------ | Description : Cleans up the XID organizing arrays for nsapis and ntts | | Parameters : | +------------------------------------------------------------------------------ */ GLOBAL void mg_clean_xid (UBYTE sapi) { UBYTE nsapi = 0; UBYTE sapi_index = 0; UBYTE stat = MG_UNASSIGNED; TRACE_FUNCTION( "mg_clean_xid" ); sndcp_get_sapi_index(sapi, &sapi_index); /* * NSAPIs that were assigned to a compressor unit but are not any more. */ for (nsapi = 0; nsapi < SNDCP_NUMBER_OF_NSAPIS; nsapi++) { BOOL connected = ((1 << nsapi) & (sndcp_data->mg.cur_xid_block[sapi_index].v42.nsapis)) > 0; mg_set_sapi_dntt_nsapi(sapi, sndcp_data->mg.cur_xid_block[sapi_index].v42.ntt, nsapi, connected); connected = ((1 << nsapi) & (sndcp_data->mg.cur_xid_block[sapi_index].vj.nsapis)) > 0; mg_set_sapi_pntt_nsapi(sapi, sndcp_data->mg.cur_xid_block[sapi_index].vj.ntt, nsapi, connected); } /* * Formerly assigned ntts that are now unassigned are cleaned. * Implemented here: the one dntt and the one pntt in cur_xid_block are now * checked. If they are in state MG_ASSIGNED but the affected 'nsapis' * element is set to all '0' then the entities enter state MG_UNASSIGNED, * all nsapis re set to FALSE in the sapi_?ntt_nsapi_ra, all * affected pcomp/dcomp values are set to MG_UNASSIGNED. */ mg_get_sapi_dntt_state(sapi, sndcp_data->mg.cur_xid_block[sapi_index].v42.ntt, &stat); if (stat == MG_ASSIGNED && sndcp_data->mg.cur_xid_block[sapi_index].v42.nsapis == 0) { /* * Reset dntt state. */ mg_set_sapi_dntt_state(sapi, sndcp_data->mg.cur_xid_block[sapi_index].v42.ntt, MG_UNASSIGNED); /* * reset nsapi connections. */ for (nsapi = 0; nsapi < SNDCP_NUMBER_OF_NSAPIS; nsapi++) { mg_set_sapi_dntt_nsapi(sapi, sndcp_data->mg.cur_xid_block[sapi_index].v42.ntt, nsapi, FALSE); } /* * Reset dcomp. */ mg_set_sapi_dcomp_state(sapi, sndcp_data->mg.cur_xid_block[sapi_index].v42.dcomp, MG_UNASSIGNED); } /* * The same for header compresion. */ mg_get_sapi_pntt_state(sapi, sndcp_data->mg.cur_xid_block[sapi_index].vj.ntt, &stat); if (stat == MG_ASSIGNED && sndcp_data->mg.cur_xid_block[sapi_index].vj.nsapis == 0) { /* * Reset pntt state. */ mg_set_sapi_pntt_state(sapi, sndcp_data->mg.cur_xid_block[sapi_index].vj.ntt, MG_UNASSIGNED); /* * reset nsapi connections. */ for (nsapi = 0; nsapi < SNDCP_NUMBER_OF_NSAPIS; nsapi++) { mg_set_sapi_pntt_nsapi(sapi, sndcp_data->mg.cur_xid_block[sapi_index].vj.ntt, nsapi, FALSE); } /* * Reset pcomps. */ mg_set_sapi_pcomp_state(sapi, sndcp_data->mg.cur_xid_block[sapi_index].vj.pcomp1, MG_UNASSIGNED); mg_set_sapi_pcomp_state(sapi, sndcp_data->mg.cur_xid_block[sapi_index].vj.pcomp2, MG_UNASSIGNED); } } /* mg_clean_xid() */ /* +------------------------------------------------------------------------------ | Function : mg_col_no_re +------------------------------------------------------------------------------ | Description : The function mg_col_no_re represents the SDL label | COL_NO_RE: an LL_ESTABLISH_IND has been received, we do | have a collision situation like given in [GSM 4.65, 6.2.1.4], | we do not have a re-establishment situation. | | Parameters : the received LL_ESTABLISH_IND | +------------------------------------------------------------------------------ */ GLOBAL void mg_col_no_re (T_LL_ESTABLISH_IND* ll_establish_ind) { TRACE_FUNCTION( "mg_col_no_re" ); /* * Resume data transfer suspended due to pending establishment; */ sig_mg_su_resume(ll_establish_ind->sapi); sig_mg_sua_resume(ll_establish_ind->sapi); mg_resume_affected_nus(ll_establish_ind->sapi); /* * Now proceed like without collision. */ mg_no_col_no_re(ll_establish_ind); } /* mg_col_no_re() */ /* +------------------------------------------------------------------------------ | Function : mg_col_re +------------------------------------------------------------------------------ | Description : The function mg_col_re represents the SDL label | COL_RE: an LL_ESTABLISH_IND has been received, we do | have a collision situation like given in [GSM 4.65, 6.2.1.4], | we do have a re-establishment situation. | | Parameters : the received LL_ESTABLISH_IND | +------------------------------------------------------------------------------ */ GLOBAL void mg_col_re (T_LL_ESTABLISH_IND* ll_establish_ind) { TRACE_FUNCTION( "mg_col_re" ); /* * Resume data transfer suspended due to pending establishment; */ sig_mg_su_resume(ll_establish_ind->sapi); sig_mg_sua_resume(ll_establish_ind->sapi); mg_resume_affected_nus(ll_establish_ind->sapi); /* * Now proceed like without collision. */ mg_no_col_re(ll_establish_ind); } /* mg_col_re() */ /* +------------------------------------------------------------------------------ | Function : mg_decode_xid +------------------------------------------------------------------------------ | Description : Implementation dependent. | The entity number | Works only for algorithm types 0 | (V42 for data and VanJacobson for header). | This procedure reads the given xid block (in form of an sdu) | and writes the fields to the given xid_block variable, if | compression fields for algorithms 0 (V42 or VanJacobson) are | given. | If the parsed sdu starts a negotiation then the p bit will be | set to 1 and the "algorithm type" field will be included. If | the parsed sdu ends a negotiation then the p bit will be set | to 0 and the "algorithm type" field will not be included. | In this case it will be checked if the "entity number" field | corresponds with the entity number set in req_xid_block. | | Note: This procedure only re-formats the xid_block. The content | of the xid_block are not checked. This will be done in a later | procedure on the basis of the xid_block filled in here. | The only error possibly detected is returned, if the byte format | of the given xid block sdu is not correct: MG_XID_BAD_FORMAT. | Then parameter type 1 list is read. If a data comp field has | an algorithm of type 0 (V42bis) then its values are written | to the given xid_block. If the algorithm is not 0 (V42bis) then | the entity is rejected. | The same for parameter type 2, here only algorithm type 0 | (VanJacobson) is written to the xid_block. | Note: it is assumed here that the parameters come in line 0, 1, 2. | If that will no be the case, the parsing will have to modified | slightly. | If an unknown parameter type (not 0, 1, 2) is detected, an | MG_XID_BAD_FORMAT is returned. | | Parameters : the sdu to be parsed, is negotiation started here?, the | destination T_XID_BLOCK, a return value that should be MG_XID_OK | +------------------------------------------------------------------------------ */ GLOBAL void mg_decode_xid (T_sdu* sdu, T_XID_BLOCK* xid_block, UBYTE* ret, UBYTE sapi) { #define CHECK_XID_BUFFER_LEN if (index + field_index >= ((sdu->l_buf) >> 3)) return UBYTE sapi_index = 0; /* * Index for the whole sdu. */ USHORT index = sdu->o_buf / 8; /* * Sub index used in compression fields. */ USHORT field_index = 0; /* * This is the index where the parameter 2 for header compression begins. */ USHORT beginning_of_header_comp = 0; /* * Length of complete parameter blocks of type 1 or 2. */ USHORT length = 0; /* * Was decoding successful? */ BOOL ok = FALSE; TRACE_FUNCTION( "mg_decode_xid" ); /* * Reset xid_block. */ sndcp_reset_xid_block(xid_block); sndcp_get_sapi_index(sapi, &sapi_index); *ret = MG_XID_BAD_FORMAT; /* * If end is reached, return with ok. */ if (sdu->l_buf == 0) { *ret = MG_XID_OK; return; } /* * If parameter type 0 is included, store it. */ CHECK_XID_BUFFER_LEN; if (sdu->buf[index] == SNDCP_XID_PARAM_TYPE_0) { index++; xid_block->version_set = TRUE; /* * Length should be SNDCP_XID_0_LEN, but is not checked. */ CHECK_XID_BUFFER_LEN; length = sdu->buf[index]; index++; /* * Set the version in xid_block. */ CHECK_XID_BUFFER_LEN; xid_block->version = sdu->buf[index]; index+= length; } /* * If end is reached, return with ok. */ if (index == ((sdu->l_buf) >> 3)) { *ret = MG_XID_OK; return; } /* * If parameter type 1 is included, store it. */ if (sdu->buf[index] == SNDCP_XID_PARAM_TYPE_1) { /* * Length of all data compression parameters. */ index++; CHECK_XID_BUFFER_LEN; length = sdu->buf[index]; /* * This is the index where the parameter 2 infos for header compression * begin. */ beginning_of_header_comp = index + length + 1; /* * Search data compression parameters for algorithm type 1. */ while (length > 0) { /* * Index is now on p-bit-entity-octet for one field. * If the p bit is set to 1 then we read the algorithm * type and drop the field if it is not SNDCP_XID_V42. * If the p bit is not set to 1 then we read the * entity number and drop the field if it is not the entity number * proposed in req_xid_block. */ /* * Set field_index to beginning of next data compression field. */ field_index++; CHECK_XID_BUFFER_LEN; if ((sdu->buf[index + field_index] & 0x80) > 0) { /* * P bit set to 1. Check algorithm type and drop field if * type is not known. * Set ntt. */ xid_block->v42.ntt = sdu->buf[index + field_index] & 0x1F; /* * Set field_index to algorithm type. */ field_index ++; CHECK_XID_BUFFER_LEN; if ((sdu->buf[index + field_index] & 0xf) != SNDCP_XID_V42) { /* * Wrong algorithm type. Add the ntt to list of rejected ones. */ mg_set_sapi_dntt_rej(sapi, xid_block->v42.ntt, TRUE); /* * Set index to length octet. */ field_index ++; /* * Set index to next field. Check field length. */ CHECK_XID_BUFFER_LEN; field_index += sdu->buf[index + field_index]; if (field_index > length) { /* * Field is too long, bad format. */ return; } if (field_index == length) { /* * Field is completed but entity number has not been found because in * that case the loop would have been left with break; */ xid_block->v42.is_set = FALSE; break; } continue; } else { /* * Correct algorithm type. */ if (xid_block->v42.is_set == FALSE) { /* * This is the first occurrence. */ xid_block->v42.is_set = TRUE; xid_block->v42.p_bit = 1; mg_decode_v42(sdu, &index, &field_index, xid_block, &ok, SNDCP_P_BIT_1); if (!ok) { /* * Decoding was not successful. */ return; } } else { /* * There has been an occurrence of this algorithm. */ /* * Set index to length octet. */ field_index ++; /* * Set index to next field. Check field length. */ CHECK_XID_BUFFER_LEN; field_index += sdu->buf[index + field_index]; if (field_index > length) { /* * Field is too long, bad format. */ return; } if (field_index == length) { /* * Field is completed. */ break; } } /* * If all data parameters are read, go ahead for header ones. */ if (field_index == length) { break; } } } else { /* * P bit set to 0. * Check entity number and drop field if it is not the proposed one or * V42 has not been proposed yet. * field_index is already on p-bit-entity-octet. */ CHECK_XID_BUFFER_LEN; if (((sdu->buf[index + field_index] & 0x1f) != xid_block->v42.ntt) && xid_block->v42.is_set) { /* * Wrong entity number. */ /* * Set field_index to length octet. */ field_index ++; /* * Set index to next field. Check field length. */ CHECK_XID_BUFFER_LEN; field_index += sdu->buf[index + field_index]; if (field_index > length) { /* * Field is too long, bad format. */ return; } if (field_index == length) { /* * Field is completed but entity number has not been found because in * that case the loop would have been left with break; */ xid_block->v42.is_set = FALSE; break; } continue; } else { /* * The entity number of this field equals the entity number in * ththat is already in the xid block or there is no entity in * the xid block yet. */ xid_block->v42.is_set = TRUE; xid_block->v42.p_bit = 0; xid_block->v42.ntt = (sdu->buf[index + field_index] & 0x1f); mg_decode_v42(sdu, &index, &field_index, xid_block, &ok, SNDCP_P_BIT_0); if (!ok) { /* * Decoding was not successful. */ return; } /* * If all data parameters are read, go ahead for header ones. */ if (field_index == length) { break; } } } /* p bit set to 0 */ } /* while */ field_index = 0; index = beginning_of_header_comp; } /* * Now comes the header compression parameter type 2. * Is it omitted? */ if (index == ((sdu->l_buf) >> 3)) { *ret = MG_XID_OK; return; } /* * Parameter type should be SNDCP_XID_PARAM_TYPE_2. */ CHECK_XID_BUFFER_LEN; if (sdu->buf[index] != SNDCP_XID_PARAM_TYPE_2) { return; } /* * Length of all header compression parameters. */ index++; CHECK_XID_BUFFER_LEN; length = sdu->buf[index]; /* * Search header compression parameters for algorithm type 2. */ while (length > 0) { /* * Index is now on p-bit-entity-octet for one field. * If the p bit is set to 1 then we read the algorithm * type and drop the field if it is not SNDCP_XID_VJ. * If the p bit is not set to 1 then we read the * entity number and drop the field if it is not the entity number * proposed in req_xid_block. */ /* * Set field_index to beginning of next header compression field. */ field_index++; CHECK_XID_BUFFER_LEN; if ((sdu->buf[index + field_index] & 0x80) > 0) { UBYTE ntt = 0; /* * P bit set to 1. Check algorithm type and drop field if * type is not known. * Set ntt. */ ntt = sdu->buf[index + field_index] & 0x1F; /* * Set index to algorithm type. */ field_index ++; CHECK_XID_BUFFER_LEN; if (((sdu->buf[index + field_index] & 0xf) != SNDCP_XID_VJ) || ((sndcp_data->mg.cur_xid_block[sapi_index].vj.is_set) && (xid_block->vj.is_set == FALSE) && (ntt != sndcp_data->mg.cur_xid_block[sapi_index].vj.ntt) ) ) { /* * Wrong algorithm type or * vj comp is currently used and proposed ntt is not equal to currently * used one. * Add ntt to list of rejected ones. */ mg_set_sapi_pntt_rej(sapi, ntt, TRUE); /* * Set index to length octet. */ field_index ++; /* * Set index to next field. Check field length. */ CHECK_XID_BUFFER_LEN; field_index += sdu->buf[index + field_index]; if (field_index > length) { /* * Field is too long, bad format. */ return; } if (field_index == length) { /* * Field is completed but entity number has not been found because in * that case the loop would have been left with break; */ xid_block->vj.is_set = FALSE; break; } continue; } /* * Correct algorithm type and vj requested. */ /* * If no vj comp is currently used and xid_block.vj is not set yet, take * the proposed one. * Also if vj comp is currently used and xid block is not yet set and * proposed ntt is equal to currently used one. */ if (((! sndcp_data->mg.cur_xid_block[sapi_index].vj.is_set) && (xid_block->vj.is_set == FALSE)) || ((sndcp_data->mg.cur_xid_block[sapi_index].vj.is_set) && (xid_block->vj.is_set == FALSE) && (ntt == sndcp_data->mg.cur_xid_block[sapi_index].vj.ntt))) { xid_block->vj.is_set = TRUE; xid_block->vj.p_bit = 1; xid_block->vj.ntt = ntt; mg_decode_vj (sdu, &index, &field_index, xid_block, &ok, SNDCP_P_BIT_1); if (!ok) { /* * Decoding was not successful. */ return; } /* * If all header parameters are read, go ahead for header ones. */ if (field_index == length) { break; } continue; } /* * This is not the first occurrence. Ignore. */ /* * Set index to length octet. */ field_index ++; /* * Set index to next field. Check field length. */ CHECK_XID_BUFFER_LEN; field_index += sdu->buf[index + field_index]; if (field_index > length) { /* * Field is too long, bad format. */ return; } if (field_index == length) { /* * Field is completed. */ break; } } else { /* * P bit set to 0. * Check entity number and drop field if it is not the proposed one or * VJ has not been proposed yet. * Index is already on p-bit-entity-octet. */ CHECK_XID_BUFFER_LEN; if (((sdu->buf[index + field_index] & 0x1f) != xid_block->vj.ntt) && xid_block->vj.is_set) { /* * Wrong entity number. * Set index to length octet. */ field_index ++; /* * Set index to next field. Check field length. */ CHECK_XID_BUFFER_LEN; field_index += sdu->buf[index + field_index]; if (field_index > length) { /* * Field is too long, bad format. */ return; } if (field_index == length) { /* * Field is completed but entity number has not been found because in * that case the loop would have been left with break; */ break; } continue; } else { /* * The entity number of this field equals the entity number in * that is already in the xid_block or there is no entity number * in the block yet. */ xid_block->vj.is_set = TRUE; xid_block->vj.p_bit = 0; xid_block->vj.ntt = (sdu->buf[index + field_index] & 0x1f); mg_decode_vj (sdu, &index, &field_index, xid_block, &ok, SNDCP_P_BIT_0); if (!ok) { /* * Decoding was not successful. */ return; } /* * The one field with same entity number as in req_xid_block has been * found and loop of data compression field may be left. * If errors in not used fields are to be detected then we must continue here! */ /* * If all header parameters are read, leave. */ if (field_index == length) { break; } } } } /* while */ /* * It is not checked here whether the sdu is completely read. */ *ret = MG_XID_OK; } /* mg_decode_xid() */ /* +------------------------------------------------------------------------------ | Function : mg_dti_close +------------------------------------------------------------------------------ | Description : Closes DTI connection | Parameters : nsapi +------------------------------------------------------------------------------ */ GLOBAL void mg_dti_close (UBYTE nsapi) { #ifdef _SNDCP_DTI_2_ UBYTE interfac = SNDCP_INTERFACE_UNACK; #ifndef SNDCP_UPM_INCLUDED sndcp_get_nsapi_interface(nsapi, &interfac); #endif /*#ifdef SNDCP_UPM_INCLUDED*/ dti_close(sndcp_data->hDTI, /* DTI_HANDLE *hDTI, */ 0, /* U8 instance, */ interfac, /* U8 interface, */ nsapi, NULL/* U8 channel); */ ); #else /*_SNDCP_DTI_2_*/ UBYTE interfac = SNDCP_INTERFACE_UNACK; sndcp_get_nsapi_interface(nsapi, &interfac); dti_close(sndcp_data->hDTI, /* DTI_HANDLE *hDTI, */ 0, /* U8 instance, */ interfac, /* U8 interface, */ nsapi /* U8 channel); */ ); #endif /*_SNDCP_DTI_2_*/ /* * The following is done in any case since the callback will not be called. */ nu_connection_state(nsapi, FALSE); /*FIXME ! Added newly. To be verified.*/ #ifdef SNDCP_UPM_INCLUDED { U32 linkid = 0; PALLOC (sn_dti_cnf, SN_DTI_CNF); sndcp_get_nsapi_linkid(nsapi, &linkid); sn_dti_cnf->dti_linkid = linkid; sn_dti_cnf->dti_conn = NAS_DISCONNECT_DTI; PSEND(hCommMMI, sn_dti_cnf); } #endif /*#ifdef SNDCP_UPM_INCLUDED*/ } /* mg_dti_close() */ /* +------------------------------------------------------------------------------ | Function : mg_dti_open +------------------------------------------------------------------------------ | Description : Opens DTI connection | Parameters : nsapi +------------------------------------------------------------------------------ */ GLOBAL void mg_dti_open (UBYTE nsapi) { #ifdef _SNDCP_DTI_2_ UBYTE* neighbor = NULL; ULONG linkid = 0; #ifndef SNDCP_UPM_INCLUDED BOOL ack = FALSE; #endif U8 direction = DTI_CHANNEL_TO_LOWER_LAYER; UBYTE interfac = SNDCP_INTERFACE_UNACK; sndcp_get_nsapi_linkid(nsapi, &linkid); sndcp_get_nsapi_neighbor(nsapi, &neighbor); #ifndef SNDCP_UPM_INCLUDED sndcp_get_nsapi_ack(nsapi, &ack); #endif sndcp_get_nsapi_direction(nsapi, &direction); #ifndef SNDCP_UPM_INCLUDED if (ack) { interfac = SNDCP_INTERFACE_ACK; sndcp_set_nsapi_interface(nsapi, interfac); } #endif dti_open(sndcp_data->hDTI, /* DTI_HANDLE hDTI */ 0, /* U8 instance */ interfac, /* U8 interface */ nsapi, /* U8 channel */ 0, /* U8 queue_size */ direction, /* U8 direction */ DTI_QUEUE_WATERMARK, /* U8 link options */ DTI_VERSION_10, /* U32 version */ neighbor, /* U8 *neighbor_entity */ linkid/* U32 link_id */ ); #else /*_SNDCP_DTI_2_*/ UBYTE* neighbor = NULL; ULONG linkid = 0; BOOL ack = FALSE; BOOL direction = HOME; UBYTE interfac = SNDCP_INTERFACE_UNACK; sndcp_get_nsapi_linkid(nsapi, &linkid); sndcp_get_nsapi_neighbor(nsapi, &neighbor); sndcp_get_nsapi_ack(nsapi, &ack); sndcp_get_nsapi_direction(nsapi, &direction); #ifndef SNDCP_UPM_INCLUDED if (ack) { interfac = SNDCP_INTERFACE_ACK; sndcp_set_nsapi_interface(nsapi, interfac); } #endif dti_open(sndcp_data->hDTI, /* DTI_HANDLE *hDTI */ 0, /* U8 instance */ interfac, /* U8 interface */ nsapi, /* U8 channel */ 0, /* U8 queue_size */ direction, /* BOOL direction */ FLOW_CNTRL_ENABLED, /* U8 comm_type */ DTI_VERSION_10, /* U32 version */ neighbor, /* U8 *neighbor_entity */ linkid/* U32 link_id */ ); #endif /*_SNDCP_DTI_2_*/ } /* mg_dti_open() */ /* +------------------------------------------------------------------------------ | Function : mg_init +------------------------------------------------------------------------------ | Description : The function mg_init() .... | | Parameters : | +------------------------------------------------------------------------------ */ GLOBAL void mg_init (void) { UBYTE sapi_index = 0; UBYTE nsapi = 0; TRACE_FUNCTION( "mg_init" ); INIT_STATE(MG, MG_DEFAULT); /* * req_xid_block, cnf_xid_block, cur_xid_block not initialized. */ for (sapi_index = 0; sapi_index < SNDCP_NUMBER_OF_SAPIS; sapi_index++) { mg_reset_states_n_rej(sapi_index); /* * Init renegotiation counter and cur_xid_block with default values. */ sndcp_data->mg.renego[sapi_index] = 0; sndcp_reset_xid_block(&sndcp_data->mg.req_xid_block[sapi_index]); sndcp_reset_xid_block(&sndcp_data->mg.cnf_xid_block[sapi_index]); sndcp_reset_xid_block(&sndcp_data->mg.ind_xid_block[sapi_index]); sndcp_reset_xid_block(&sndcp_data->mg.res_xid_block[sapi_index]); sndcp_reset_xid_block(&sndcp_data->mg.cur_xid_block[sapi_index]); sndcp_reset_xid_block(&sndcp_data->mg.new_xid_block[sapi_index]); } for (nsapi = 0; nsapi < SNDCP_NUMBER_OF_NSAPIS; nsapi++) { sndcp_reset_xid_block(&sndcp_data->mg.user_xid_block[nsapi]); sndcp_data->mg.user_xid_block[nsapi].vj.s0_m_1 = 0; sndcp_data->cur_pcomp[nsapi] = 0; sndcp_data->cur_dcomp[nsapi] = 0; sndcp_data->cur_seg_pos[nsapi] = 0; sndcp_data->cur_pdu_ref[nsapi].ref_nsapi = 0; sndcp_data->cur_pdu_ref[nsapi].ref_npdu_num = 0; sndcp_data->cur_pdu_ref[nsapi].ref_seg_num = 0; sndcp_data->big_head[nsapi] = FALSE; } sndcp_data->mg.mod_expects = MG_MOD_X_NONE; sndcp_data->mg.waiting_nsapis = 0; sndcp_data->mg.suspended_nsapis = 0; } /* mg_init() */ /* +------------------------------------------------------------------------------ | Function : mg_is_ack +------------------------------------------------------------------------------ | Description : This procedure takes the snsm_qos!rely | information: | | 0 SNSM_RELCLASS_SUB Subscribed reliability class | 1 SNSM_GTP_LLC_RLC_PROT Acknowledged GTP, LLC, and RLC; Protected data | 2 SNSM_LLC_RLC_PROT Unacknowledged GTP; Acknowledged LLC and RLC, Protected data | 3 SNSM_RLC_PROT Unacknowledged GTP and LLC; Acknowledged RLC, Protected data | 4 SNSM_PROT Unacknowledged GTP, LLC, and RLC, Protected data | 5 SNSM_NO_REL Unacknowledged GTP, LLC, and RLC, Unprotected data | | and sets "spec" to TRUE, "b" to TRUE in case of SNSM_GTP_LLC_RLC_PROT or | SNSM_LLC_RLC_PROT, | [should be, is not:["spec" to FALSE in case of SNSM_RELCLASS_SUB]] and "spec" | to TRUE, "b" to FALSE else. | | Important note: in case of SNSM_RELCLASS_SUB "spec" will actually be set to | to TRUE, "b" to FALSE, to be robust in case of downlink protocol error! | | Parameters : snsm_qos | BOOL* spec (FALSE for REL_CLASS_SUB), | BOOL* b) | +------------------------------------------------------------------------------ */ GLOBAL void mg_is_ack (T_snsm_qos snsm_qos, BOOL* spec, BOOL* b) { TRACE_FUNCTION( "mg_is_ack" ); #ifdef SNDCP_UPM_INCLUDED if (snsm_qos.relclass == PS_GTP_LLC_RLC_PROT || snsm_qos.relclass == PS_LLC_RLC_PROT) { #else if (snsm_qos.relclass == SNSM_GTP_LLC_RLC_PROT || snsm_qos.relclass == SNSM_LLC_RLC_PROT) { #endif /*#ifdef SNDCP_UPM_INCLUDED*/ *spec = TRUE; *b = TRUE; /* } else if (snsm_qos.relclass == SNSM_RELCLASS_SUB) { *spec = FALSE; */ } else { *spec = TRUE; *b = FALSE; } } /* mg_is_ack() */ /* +------------------------------------------------------------------------------ | Function : mg_no_col_no_re +------------------------------------------------------------------------------ | Description : The function mg_no_col_no_re represents the SDL label | NO_COL_NO_RE: an LL_ESTABLISH_IND has been received, we do not | have a collision situation like given in [GSM 4.65, 6.2.1.4], | we do not have a re-establishment situation. | | Parameters : the received LL_ESTABLISH_IND | +------------------------------------------------------------------------------ */ GLOBAL void mg_no_col_no_re (T_LL_ESTABLISH_IND* ll_establish_ind) { UBYTE dec_ret = 0; UBYTE check_ret = 0; UBYTE sapi_index = 0; U8 nsapi = 0; TRACE_FUNCTION( "mg_no_col_no_re" ); sndcp_get_sapi_index(ll_establish_ind->sapi, &sapi_index); TRACE_EVENT_P3("l3_valid?: %d, N201_I: %d, N201_U: %d", ll_establish_ind->xid_valid, ll_establish_ind->n201_i, ll_establish_ind->n201_u); /* * Set N201 values in uplink services. */ sig_mg_su_n201(ll_establish_ind->sapi, ll_establish_ind->n201_u); sig_mg_sua_n201(ll_establish_ind->sapi, ll_establish_ind->n201_i); /* * If SNDCP XID block is not valid, we are ready. */ if (ll_establish_ind->xid_valid == LL_XID_INVALID) { PALLOC_SDU (ll_establish_res, LL_ESTABLISH_RES, 0); /* * Set sapi in ll_establish_res. */ ll_establish_res->sapi = ll_establish_ind->sapi; ll_establish_res->xid_valid = ll_establish_ind->xid_valid; ll_establish_res->sdu.l_buf = 0; /* * Mark the affected sapi as MG_XID_IDLE. */ sndcp_unset_sapi_state(ll_establish_ind->sapi, MG_EST); sig_mg_sda_end_est(ll_establish_res->sapi, TRUE); sndcp_set_sapi_ack(ll_establish_res->sapi, TRUE); PSEND(hCommLLC, ll_establish_res); /* * All nsapis at this sapi that use ack mode, enter recovery state. */ for (nsapi = 0; nsapi < SNDCP_NUMBER_OF_NSAPIS; nsapi ++) { UBYTE sapi = 0; BOOL ack = FALSE; sndcp_get_nsapi_sapi(nsapi, &sapi); sndcp_get_nsapi_ack(nsapi, &ack); if (ack && (sapi == ll_establish_ind->sapi)) { sig_mg_cia_delete_npdus(nsapi); sig_mg_sua_delete_pdus(nsapi, sapi, FALSE); sig_mg_nu_recover(nsapi); sig_mg_nd_recover(nsapi); } } /* for all nsapis */ return; } /* * SNDCP XID block is valid and checked now. */ mg_decode_xid(&(ll_establish_ind->sdu), &(sndcp_data->mg.ind_xid_block[sapi_index]), &dec_ret, ll_establish_ind->sapi); if (dec_ret == MG_XID_OK) { mg_check_ind_xid(&check_ret, ll_establish_ind->sapi); if (check_ret == MG_XID_OK) { /* * Label MG_IND_OK_EST */ USHORT res_sdu_bit_len = 0; UBYTE ntt = 0; BOOL v42_rej = FALSE; BOOL vj_rej = FALSE; mg_set_res_cur_xid_block(ll_establish_ind->sapi, &res_sdu_bit_len); /* * Add the extra space for ntts with nsapis == 0. */ for (ntt = 0; ntt < MG_MAX_ENTITIES; ntt++) { BOOL rej = FALSE; mg_get_sapi_dntt_rej(ll_establish_ind->sapi, ntt, &rej); if (rej) { /* * length of ntt octet and nsapis. */ res_sdu_bit_len += 32; v42_rej = TRUE; } mg_get_sapi_pntt_rej(ll_establish_ind->sapi, ntt, &rej); if (rej) { /* * length of ntt octet and nsapis. */ res_sdu_bit_len += 32; vj_rej = TRUE; } } if (! sndcp_data->mg.res_xid_block[sapi_index].v42.is_set && v42_rej) { /* * Add length of parameter type and length. */ res_sdu_bit_len += 16; } if (! sndcp_data->mg.res_xid_block[sapi_index].vj.is_set && vj_rej) { /* * Add length of parameter type and length. */ res_sdu_bit_len += 16; } /* * SDL Label MG_CNF_OK_ACK */ { USHORT sapi_state = MG_IDLE; PALLOC_SDU (ll_establish_res, LL_ESTABLISH_RES, res_sdu_bit_len); /* * Set sapi in ll_establish_res. */ ll_establish_res->sapi = ll_establish_ind->sapi; ll_establish_res->xid_valid = ll_establish_ind->xid_valid; /* * Write res_xid_block struct to sdu byte buffer. Implementation dep.. */ mg_set_res_xid_params(&ll_establish_res->sdu, ll_establish_res->sapi); /* * Mark the affected nsapis and sapi as MG_XID_IDLE. */ sndcp_unset_sapi_state(ll_establish_ind->sapi, MG_XID); sndcp_unset_sapi_state(ll_establish_ind->sapi, MG_EST); sig_mg_sda_end_est(ll_establish_res->sapi, TRUE); sndcp_set_sapi_ack(ll_establish_res->sapi, TRUE); PSEND(hCommLLC, ll_establish_res); /* * All nsapis at this sapi that use ack mode, enter recovery state. */ for (nsapi = 0; nsapi < SNDCP_NUMBER_OF_NSAPIS; nsapi ++) { UBYTE sapi = 0; BOOL ack = FALSE; sndcp_get_nsapi_sapi(nsapi, &sapi); sndcp_get_nsapi_ack(nsapi, &ack); if (ack && (sapi == ll_establish_ind->sapi)) { sig_mg_cia_delete_npdus(nsapi); sig_mg_sua_delete_pdus(nsapi, sapi, FALSE); sig_mg_nu_recover(nsapi); sig_mg_nd_recover(nsapi); } } /* for all nsapis */ /* * Reset nsapis or ntts that were assigned, but are not any more. */ mg_clean_xid(ll_establish_ind->sapi); /* * If there was a collision and xid has not been negotiated * sufficiently. */ mg_resend_xid_if_nec(ll_establish_ind->sapi); /* * If nsapi has been in state xid_pending or est_pending then * an snsm_activate_res will be sent now.!!! */ mg_respond_if_nec(ll_establish_ind->sapi); sndcp_get_sapi_state(ll_establish_ind->sapi, &sapi_state); if ((sapi_state & MG_XID) == 0) { mg_xid_cnf_ok_res(ll_establish_ind->sapi); } } } else { /* * not (check_ret == MG_IND_XID_OK) */ /* * Label MG_CHECK_FAIL_EST */ USHORT res_sdu_bit_len = 0; UBYTE ntt = 0; BOOL v42_rej = FALSE; BOOL vj_rej = FALSE; /* * Add the extra space for ntts with nsapis == 0. */ for (ntt = 0; ntt < MG_MAX_ENTITIES; ntt++) { BOOL rej = FALSE; mg_get_sapi_dntt_rej(ll_establish_ind->sapi, ntt, &rej); if (rej) { /* * length of ntt octet and nsapis. */ res_sdu_bit_len += 32; v42_rej = TRUE; } mg_get_sapi_pntt_rej(ll_establish_ind->sapi, ntt, &rej); if (rej) { /* * length of ntt octet and nsapis. */ res_sdu_bit_len += 32; vj_rej = TRUE; } } if (v42_rej) { /* * Add length of parameter type and length. */ res_sdu_bit_len += 16; } if (vj_rej) { /* * Add length of parameter type and length. */ res_sdu_bit_len += 16; } /* * Allocate response and send it. */ { PALLOC_SDU (ll_establish_res, LL_ESTABLISH_RES, res_sdu_bit_len); /* * Reset res_xid_block, ind_xid_block. */ sndcp_reset_xid_block(&sndcp_data->mg.res_xid_block[sapi_index]); sndcp_reset_xid_block(&sndcp_data->mg.ind_xid_block[sapi_index]); /* * Set sapi in ll_establish_res. */ ll_establish_res->sapi = ll_establish_ind->sapi; ll_establish_res->xid_valid = ll_establish_ind->xid_valid; /* * Write res_xid_block struct to sdu byte buffer. Implementation dep.. */ mg_set_res_xid_params(&ll_establish_res->sdu, ll_establish_ind->sapi); /* * Modify the affected sapi state. */ sndcp_unset_sapi_state(ll_establish_ind->sapi, MG_XID); sndcp_unset_sapi_state(ll_establish_ind->sapi, MG_EST); sndcp_set_sapi_ack(ll_establish_res->sapi, TRUE); /* * Send the XID block to LLC. */ PSEND(hCommLLC, ll_establish_res); /* * All nsapis at this sapi that use ack mode, enter recovery state. */ for (nsapi = 0; nsapi < SNDCP_NUMBER_OF_NSAPIS; nsapi ++) { UBYTE sapi = 0; BOOL ack = FALSE; sndcp_get_nsapi_sapi(nsapi, &sapi); sndcp_get_nsapi_ack(nsapi, &ack); if (ack && (sapi == ll_establish_ind->sapi)) { sig_mg_cia_delete_npdus(nsapi); sig_mg_sua_delete_pdus(nsapi, sapi, FALSE); sig_mg_nu_recover(nsapi); sig_mg_nd_recover(nsapi); } } /* for all nsapis */ } /* * Reset nsapis or ntts that were assigned before * but are not anymore. */ sndcp_reset_xid_block(&sndcp_data->mg.cur_xid_block[sapi_index]); mg_clean_xid(ll_establish_ind->sapi); /* * Allocate status req and send it (label MG_SEND_STATUS_REQ_EST). */ { #ifdef SNDCP_UPM_INCLUDED PALLOC (snsm_status_req, SN_STATUS_IND); #else PALLOC (snsm_status_req, SNSM_STATUS_REQ); #endif /*#ifdef SNDCP_UPM_INCLUDED*/ snsm_status_req->sapi = ll_establish_ind->sapi; #ifdef SNDCP_UPM_INCLUDED snsm_status_req->ps_cause.ctrl_value = CAUSE_is_from_sndcp; snsm_status_req->ps_cause.value.sn_cause = CAUSE_SN_INVALID_XID; PSEND (hCommUPM, snsm_status_req); #else snsm_status_req->status_cause = SNSM_RELCS_INVALID_XID; PSEND (hCommSM, snsm_status_req); #endif /*#ifdef SNDCP_UPM_INCLUDED*/ } } } else { /* not if (dec_ret == MG_XID_OK_EST) */ /* * Reset nsapis or ntts that were assigned before * but are not anymore. */ sndcp_reset_xid_block(&sndcp_data->mg.cur_xid_block[sapi_index]); mg_clean_xid(ll_establish_ind->sapi); /* * Decoding of ll_establish_ind failed (label MG_SEND_STATUS_REQ). * Allocate status req and send it. */ { #ifdef SNDCP_UPM_INCLUDED PALLOC (snsm_status_req, SN_STATUS_IND); snsm_status_req->sapi = ll_establish_ind->sapi; snsm_status_req->ps_cause.ctrl_value = CAUSE_is_from_sndcp; snsm_status_req->ps_cause.value.sn_cause = CAUSE_SN_INVALID_XID; PSEND (hCommUPM, snsm_status_req); #else PALLOC (snsm_status_req, SNSM_STATUS_REQ); snsm_status_req->sapi = ll_establish_ind->sapi; snsm_status_req->status_cause = SNSM_RELCS_INVALID_XID; PSEND (hCommSM, snsm_status_req); #endif /*#ifdef SNDCP_UPM_INCLUDED*/ } } } /* mg_no_col_no_re() */ /* +------------------------------------------------------------------------------ | Function : mg_no_col_re +------------------------------------------------------------------------------ | Description : The function mg_no_col_no_re represents the SDL label | NO_COL_RE: an LL_ESTABLISH_IND has been received, we do not | have a collision situation like given in [GSM 4.65, 6.2.1.4], | we do have a re-establishment situation. | | Parameters : the received LL_ESTABLISH_IND | +------------------------------------------------------------------------------ */ GLOBAL void mg_no_col_re (T_LL_ESTABLISH_IND* ll_establish_ind) { TRACE_FUNCTION( "mg_no_col_re" ); /* * Do the same things as without collision. */ mg_no_col_no_re (ll_establish_ind); } /* mg_no_col_re() */ /* +------------------------------------------------------------------------------ | Function : mg_re_negotiate +------------------------------------------------------------------------------ | Description : The answer to the sent LL_XID_REQ has been invalid | (bad format or content). If service var renego < MG_MAX_RENEGO then | same LL_XID_REQ is resent, else SNSM_STATUS_REQ is sent. | This function represents the SDl label MG_RE_NEGOTIATE. | | Parameters : the affected sapi | +------------------------------------------------------------------------------ */ GLOBAL void mg_re_negotiate (UBYTE sapi) { UBYTE sapi_index = 0; TRACE_FUNCTION( "mg_re_negotiate" ); sndcp_get_sapi_index(sapi, &sapi_index); /* * If number of re-negotiations is reached, deactivate all pdp contexts for * the affected sapi. */ if (sndcp_data->mg.renego[sapi_index] < MG_MAX_RENEGO) { PALLOC_SDU(ll_xid_req, LL_XID_REQ, SNDCP_XID_BLOCK_BIT_LEN); /* * Set sapi in ll_xid_req. */ ll_xid_req->sapi = sapi; /* * Fill the XID block. Implementation dependent. */ mg_set_xid_params(ll_xid_req->sapi, &ll_xid_req->sdu, sndcp_data->mg.req_xid_block[sapi_index]); /* * Send the XID block to LLC. */ sndcp_unset_sapi_state(sapi, MG_XID_NEC); sndcp_set_sapi_state(ll_xid_req->sapi, MG_XID); PSEND(hCommLLC, ll_xid_req); /* * Increment renegotiation counter. */ sndcp_data->mg.renego[sapi_index]++; } else { #ifdef SNDCP_UPM_INCLUDED PALLOC (snsm_status_req, SN_STATUS_IND); #else PALLOC (snsm_status_req, SNSM_STATUS_REQ); #endif /*#ifdef SNDCP_UPM_INCLUDED*/ /* * Set all ntts and dcomp/pcomp states to "unassigned". */ mg_reset_states_n_rej(sapi_index); /* * Set prim parameters. */ #ifdef SNDCP_UPM_INCLUDED snsm_status_req->sapi = sapi; snsm_status_req->ps_cause.ctrl_value = CAUSE_is_from_sndcp; snsm_status_req->ps_cause.value.sn_cause = CAUSE_SN_INVALID_XID; #else snsm_status_req->sapi = sapi; snsm_status_req->status_cause = SNSM_RELCS_INVALID_XID; #endif /*#ifdef SNDCP_UPM_INCLUDED*/ sndcp_data->mg.renego[sapi_index] = 0; /* * Reset cur_xid_block. */ sndcp_reset_xid_block(&sndcp_data->mg.cur_xid_block[sapi_index]); /* * Reset all compression entities for the affected sapi. */ mg_clean_xid(sapi); #ifdef SNDCP_UPM_INCLUDED PSEND (hCommUPM, snsm_status_req); #else PSEND (hCommSM, snsm_status_req); #endif } } /* mg_re_negotiate() */ /* +------------------------------------------------------------------------------ | Function : mg_re_negotiate_ack +------------------------------------------------------------------------------ | Description : The answer to the sent LL_ESTABLISH_REQ has been invalid | (bad format or content). If service var renego < MG_MAX_RENEGO then | same LL_ESTABLISH_REQ is resent, else SNSM_STATUS_REQ is sent. | This function represents the SDl label MG_RE_NEGOTIATE_ACK. | | Parameters : the affected sapi, cause | +------------------------------------------------------------------------------ */ GLOBAL void mg_re_negotiate_ack (UBYTE sapi, U16 cause) { UBYTE sapi_index = 0; TRACE_FUNCTION( "mg_re_negotiate_ack" ); sndcp_get_sapi_index(sapi, &sapi_index); /* * If number of re-negotiations is reached, deactivate all pdp contexts for * the affected sapi. */ if (sndcp_data->mg.renego[sapi_index] < MG_MAX_RENEGO) { PALLOC_SDU(ll_establish_req, LL_ESTABLISH_REQ, SNDCP_XID_BLOCK_BIT_LEN); /* * Set sapi in ll_establish_req. */ ll_establish_req->sapi = sapi; /* * Fill the XID block. Implementation dependent. */ mg_set_xid_params(ll_establish_req->sapi, &ll_establish_req->sdu, sndcp_data->mg.req_xid_block[sapi_index]); /* * Send the XID block to LLC, with establish request. */ sig_mg_sda_start_est(sapi); PSEND(hCommLLC, ll_establish_req); /* * Increment renegotiation counter. */ sndcp_data->mg.renego[sapi_index]++; } else { #ifdef SNDCP_UPM_INCLUDED PALLOC (snsm_status_req, SN_STATUS_IND); #else PALLOC (snsm_status_req, SNSM_STATUS_REQ); #endif /*#ifdef SNDCP_UPM_INCLUDED*/ /* * Service sda may now leave state SDA_ESTABLISH_REQUESTED. */ sig_mg_sda_end_est(sapi, FALSE); /* * Set all ntts and dcomp/pcomp states to "unassigned". */ mg_reset_states_n_rej(sapi_index); /* * Set prim parameters. */ #ifdef SNDCP_UPM_INCLUDED snsm_status_req->sapi = sapi; snsm_status_req->ps_cause.ctrl_value = CAUSE_is_from_sndcp; #else snsm_status_req->sapi = sapi; #endif /*#ifdef SNDCP_UPM_INCLUDED*/ sndcp_data->mg.renego[sapi_index] = 0; /* * Reset cur_xid_block. */ sndcp_reset_xid_block(&sndcp_data->mg.cur_xid_block[sapi_index]); sndcp_reset_xid_block(&sndcp_data->mg.req_xid_block[sapi_index]); /* * Reset all compression entities for the affected sapi. */ mg_clean_xid(sapi); /* * The renegotiation is failed. If the cause is NO_PEER_RESPONSE * or DM_RECEIVED, set it to RELCS_NORMAL to make SM deactivate * PDP context. Otherwise the cause is forwarded to SM and the SM * will deactivate PDP context depending on cause. */ #ifdef SNDCP_UPM_INCLUDED if((cause == CAUSE_SN_NO_PEER_RESPONSE) || (cause == CAUSE_SN_DM_RECEIVED) ){ snsm_status_req->ps_cause.value.sn_cause = CAUSE_SN_NORMAL_RELEASE; #else /* SNDCP_UPM_INCLUDED */ #ifdef _SNDCP_DTI_2_ if((cause == LL_RELCS_NO_PEER_RES) || (cause == LL_RELCS_DM_RECEIVED) ){ snsm_status_req->ps_cause.value.sn_cause = LL_RELCS_NORMAL; #else if((cause == CAUSE_SN_NO_PEER_RESPONSE) || (cause == CAUSE_SN_DM_RECEIVED) ){ snsm_status_req->ps_cause.value.sn_cause = CAUSE_SN_NORMAL_RELEASE; #endif #endif /* SNDCP_UPM_INCLUDED */ sig_mg_su_resume(sapi); sig_mg_sua_resume(sapi); mg_resume_affected_nus(sapi); sndcp_unset_sapi_state (sapi, MG_EST); } else { #ifdef SNDCP_UPM_INCLUDED snsm_status_req->ps_cause.value.sn_cause = cause; #else snsm_status_req->status_cause = cause; #endif } #ifdef SNDCP_UPM_INCLUDED PSEND (hCommUPM, snsm_status_req); #else PSEND (hCommSM, snsm_status_req); #endif } } /* mg_re_negotiate_ack() */ /* +------------------------------------------------------------------------------ | Function : mg_resend_xid_if_nec +------------------------------------------------------------------------------ | Description : This procedure will be called after reception and computation | of an LL_XID_IND or LL_ESTABLISH_IND in case of a collision | or after receiving LL_XID_CNF or LL_ESTABLISH_CNF and does the | following: | (GSM 04.65 version 6.5.1 Release 1997), 6.2.1.4: | If the | LL-ESTABLISH.request or LL-XID.request contains one or more XID parameters, | or one or more compression fields | in an XID parameter, or one or more parameters in a compression field, | that are not negotiated as part of the collision | resolution, then negotiation of these XID parameters shall be performed at | the earliest opportunity after conclusion of | the collision resolution. | | Parameters : Affected sapi, out: was LL_XID_REQ sent? | +------------------------------------------------------------------------------ */ GLOBAL void mg_resend_xid_if_nec (UBYTE sapi) { UBYTE sapi_index = 0; BOOL resend_necessary = FALSE; USHORT sapi_state = MG_IDLE; T_XID_BLOCK* req_xid_block = NULL; T_XID_BLOCK* cur_xid_block = NULL; T_XID_BLOCK* new_xid_block = NULL; TRACE_FUNCTION( "mg_resend_xid_if_nec" ); sndcp_get_sapi_index(sapi, &sapi_index); req_xid_block = &sndcp_data->mg.req_xid_block[sapi_index]; cur_xid_block = &sndcp_data->mg.cur_xid_block[sapi_index]; new_xid_block = &sndcp_data->mg.new_xid_block[sapi_index]; /* * Data compression. */ /* * If a context is deactivated, maybe compressors must be switched off. */ if (cur_xid_block->v42.is_set) { USHORT nsapis = cur_xid_block->v42.nsapis; UBYTE nsapi = 0; /* * XID renegotiation will only be necessary if one of the nsapis * that are requested to use the data compression is in state * MG_DEACT. */ for (nsapi = 0; nsapi < SNDCP_NUMBER_OF_NSAPIS; nsapi++) { if (((1 << nsapi) & nsapis) > 0) { USHORT state = MG_IDLE; sndcp_get_nsapi_state(nsapi, &state); if ((state & MG_DEACT) > 0) { UBYTE dntt = cur_xid_block->v42.ntt; resend_necessary = TRUE; mg_set_sapi_dntt_rej(sapi, dntt, TRUE); } } } } if (req_xid_block->v42.is_set && ! cur_xid_block->v42.is_set) { UBYTE sapi_index_local = 0; BOOL used = FALSE; /* * If one instance of v42 is used at a different sapi, * we may not use another one here. */ for (sapi_index_local = 0; sapi_index_local < SNDCP_NUMBER_OF_SAPIS; sapi_index_local++) { if (sndcp_data->mg.cur_xid_block[sapi_index_local].v42.is_set) { used = TRUE; } } if (! used) { USHORT nsapis = req_xid_block->v42.nsapis; UBYTE nsapi = 0; /* * XID renegotiation will only be necessary if one of the nsapis * that are requested to use the data compression are not all in state * MG_DEACT. */ for (nsapi = 0; nsapi < SNDCP_NUMBER_OF_NSAPIS; nsapi++) { if (((1 << nsapi) & nsapis) > 0) { USHORT state = MG_IDLE; sndcp_get_nsapi_state(nsapi, &state); if ((state & MG_DEACT) == 0) { resend_necessary = TRUE; } } } } } /* * Header compression. */ /* * If a context is deactivated, maybe compressors must be switched off. */ if (cur_xid_block->vj.is_set) { USHORT nsapis = cur_xid_block->vj.nsapis; UBYTE nsapi = 0; /* * XID renegotiation will only be necessary if one of the nsapis * that are requested to use the header compression is in state * MG_DEACT. */ for (nsapi = 0; nsapi < SNDCP_NUMBER_OF_NSAPIS; nsapi++) { if (((1 << nsapi) & nsapis) > 0) { USHORT state = MG_IDLE; sndcp_get_nsapi_state(nsapi, &state); if ((state & MG_DEACT) > 0) { UBYTE pntt = cur_xid_block->vj.ntt; resend_necessary = TRUE; mg_set_sapi_pntt_rej(sapi, pntt, TRUE); } } } } /* * If a compressor is requested and not yet negotiated it must be requested * now. */ if (req_xid_block->vj.is_set && !cur_xid_block->vj.is_set) { USHORT nsapis = req_xid_block->vj.nsapis; UBYTE nsapi = 0; req_xid_block->vj.p_bit = 1; /* * XID renegotiation will only be necessary if the affected nsapis * is not currently being deactivated. */ for (nsapi = 0; nsapi < SNDCP_NUMBER_OF_NSAPIS; nsapi++) { if (((1 << nsapi) & nsapis) > 0) { USHORT state = MG_IDLE; sndcp_get_nsapi_state(nsapi, &state); if ((state & MG_DEACT) == 0) { resend_necessary = TRUE; } } } } /* * If in the meantime more compression has been requested, * or compressors must be deactivated, * re-negotiate. */ if (new_xid_block->v42.is_set) { if ((! req_xid_block->v42.is_set) || (req_xid_block->v42.is_set && (new_xid_block->v42.nsapis != req_xid_block->v42.nsapis))) { *req_xid_block = *new_xid_block; resend_necessary = TRUE; } } /* * If in the meantime more compression has been requested, * or compressors must be deactivated, * re-negotiate. */ if (new_xid_block->vj.is_set) { if ((! req_xid_block->vj.is_set) || (req_xid_block->vj.is_set && (new_xid_block->vj.nsapis != req_xid_block->vj.nsapis))) { *req_xid_block = *new_xid_block; resend_necessary = TRUE; } } sndcp_get_sapi_state(sapi, &sapi_state); /* * If re-negotiation is necessary but not possible because MG_REL or * MG_XID, set MG_XID_NEC. */ if (resend_necessary && ((sapi_state & (MG_REL + MG_XID)) > 0)) { sndcp_set_sapi_state(sapi, MG_XID_NEC); mg_set_cur_xid_block(sapi); return; } /* * If renegotiation of XID is necessary, send LL_XID_REQ. */ if (! resend_necessary) { // mg_set_cur_xid_block(sapi); return; } /* * Now req_xid_block is in good shape. Send it. */ { PALLOC_SDU(ll_xid_req, LL_XID_REQ, SNDCP_XID_BLOCK_BIT_LEN); /* * Set sapi in ll_xid_req. */ ll_xid_req->sapi = sapi; /* * Write data from snsm_activate_ind to service variable req_xid_block. */ mg_set_ntt_comp(sapi); /* * Fill the XID block. Implementation dependent. */ mg_set_xid_params(ll_xid_req->sapi, &ll_xid_req->sdu, sndcp_data->mg.req_xid_block[sapi_index]); /* * Mark the affected sapi as MG_XID. */ sndcp_set_sapi_state(sapi, MG_XID); sndcp_unset_sapi_state(sapi, MG_XID_NEC); /* * Uplink data transfer on SAPI is completely suspended. */ sig_mg_su_suspend(sapi); sig_mg_sua_suspend(sapi); mg_suspend_affected_nus(sapi); /* * Send the XID block to LLC. */ sndcp_unset_sapi_state(sapi, MG_XID_NEC); sndcp_set_sapi_state(ll_xid_req->sapi, MG_XID); PSEND(hCommLLC, ll_xid_req); } } /* mg_resend_xid_if_nec() */ /* +------------------------------------------------------------------------------ | Function : mg_resume_affected_nus +------------------------------------------------------------------------------ | Description : Resumes all nu service instances affected by | If nsapi is waiting for SNSM_SEQUENCE_IND, fct. returns. | | Parameters : sapi | +------------------------------------------------------------------------------ */ GLOBAL void mg_resume_affected_nus (UBYTE sapi) { UBYTE nsapi = 0; TRACE_FUNCTION( "mg_resume_affected_nus" ); for (nsapi = 0; nsapi < SNDCP_NUMBER_OF_NSAPIS; nsapi++) { UBYTE local_sapi = 0; sndcp_get_nsapi_sapi(nsapi, &local_sapi); if (local_sapi == sapi) { USHORT nsapi_state = 0; sndcp_get_nsapi_state(nsapi, &nsapi_state); if ((nsapi_state & MG_SEQ) > 0) { return; } if (((1 << nsapi) & sndcp_data->mg.suspended_nsapis) > 0) { sig_mg_nu_resume(nsapi); sndcp_data->mg.suspended_nsapis &= (~ (ULONG)(1 << nsapi)); } } } } /* mg_resume_affected_nus() */ /* +------------------------------------------------------------------------------ | Function : mg_is_rel_comp_nec +------------------------------------------------------------------------------ | Description : This function will be called in course of the deactivation of | the given nsapi. If the nsapi used a certain compressor, | but has been the only one to do this, then with the | compressor entity will also have to | be deactivated and all affected | arrays will be modified. | Parameters : UBYTE nsapi -- the given nsapi | BOOL* nec, a compressor | Post : An "mg_set_sapi_[p/d]ntt_rej(sapi, pntt, TRUE);" will be called | for | each entity to be released. Later this information may be used | to build up the right xid negotiation. | +------------------------------------------------------------------------------ */ GLOBAL void mg_is_rel_comp_nec (UBYTE nsapi, BOOL* nec) { UBYTE dntt = 0; UBYTE pntt = 0; UBYTE sapi = 0; UBYTE nsp = 0; TRACE_FUNCTION( "mg_is_rel_comp_nec" ); sndcp_get_nsapi_sapi(nsapi, &sapi); /* * Which pntt is used? */ for (pntt = 0; pntt < MG_MAX_ENTITIES; pntt++) { UBYTE state = MG_UNASSIGNED; BOOL used = FALSE; BOOL another = FALSE; BOOL rej_known = FALSE; /* * Is pntt already known to be deactivated? */ mg_get_sapi_pntt_rej(sapi, pntt, &rej_known); if (rej_known) { *nec = TRUE; continue; } /* * Is ntt used? */ mg_get_sapi_pntt_state(sapi, pntt, &state); if (state == MG_UNASSIGNED) { continue; } /* * Does the given nsapi use it? */ mg_get_sapi_pntt_nsapi(sapi, pntt, nsapi, &used); if (! used) { continue; } /* * Is the given nsapi the only user? */ for (nsp = 0; nsp < SNDCP_NUMBER_OF_NSAPIS; nsp++) { mg_get_sapi_pntt_nsapi(sapi, pntt, nsp, &used); if (used && nsapi != nsp) { another = TRUE; } } if (another) { continue; } mg_set_sapi_pntt_rej(sapi, pntt, TRUE); *nec = TRUE; } /* * Which dntt is used? */ for (dntt = 0; dntt < MG_MAX_ENTITIES; dntt++) { UBYTE state = MG_UNASSIGNED; BOOL used = FALSE; BOOL another = FALSE; BOOL rej_known = FALSE; /* * Is pntt already known to be deactivated? */ mg_get_sapi_dntt_rej(sapi, dntt, &rej_known); if (rej_known) { *nec = TRUE; continue; } /* * Is ntt used? */ mg_get_sapi_dntt_state(sapi, dntt, &state); if (state == MG_UNASSIGNED) { continue; } /* * Does the given nsapi use it? */ mg_get_sapi_dntt_nsapi(sapi, dntt, nsapi, &used); if (! used) { continue; } /* * Is the given nsapi the only user? */ for (nsp = 0; nsp < SNDCP_NUMBER_OF_NSAPIS; nsp++) { mg_get_sapi_dntt_nsapi(sapi, dntt, nsp, &used); if (used && nsapi != nsp) { another = TRUE; } } if (another) { continue; } mg_set_sapi_dntt_rej(sapi, dntt, TRUE); *nec = TRUE; } } /* mg_is_rel_comp_nec() */ /* +------------------------------------------------------------------------------ | Function : mg_rel_nsapi_nec +------------------------------------------------------------------------------ | Description : The SAPI connected to this NSAPI shall release acknowledged LLC | operation mode if the indicated NSAPI is the last one using | acknowledged mode on this SAPI. If an LL_RELEASE_REQ is sent | then the given NSAPI (the one in parameter!) shall enter state | MG_REL and wait for an LL_RELEASE_CNF. If the affected | NSAPI doesn't use ack mode then the procedure just returns. | If the affected sapi does not use acknowledged LLC operation | mode then the procedure just returns. | If an LL_ESTABLISH_REQ or LL_XID_REQ for the affected sapi is | pending, no LL_RELEASE_REQ primitive will be sent, but the | flag MG_REL_NEC_LOC will be set. | Pre : This procedure is called after receipt of an | SNSM_DEACTIVATE_IND, so the "local" parameter in an | LL_RELEASE_REQ will be set to LL_REL_LOCAL. | The procedure will only be called if the given nsapi is | currently using acknowledged LLC operation mode, so this | does not have to be checked. | Parameters : UBYTE nsapi -- the given nsapi | +------------------------------------------------------------------------------ */ GLOBAL void mg_rel_nsapi_nec (UBYTE nsapi) { UBYTE sapi = 0; UBYTE npi = 0; UBYTE spi = 0; USHORT sapi_state = MG_IDLE; /* * Are there other contexts using acknowledged mode on the same SAPI? */ BOOL another_ack = FALSE; BOOL sack = FALSE; TRACE_FUNCTION( "mg_rel_nsapi_nec" ); /* * Which SAPI is connected to the given NSAPI? */ sndcp_get_nsapi_sapi(nsapi, &sapi); sndcp_get_sapi_ack(sapi, &sack); sndcp_get_sapi_state(sapi, &sapi_state); if(!sack){ if ((sapi_state & MG_EST) != 0) { sndcp_set_sapi_state(sapi, MG_REL_NEC_LOC); } return; } /* * If release is pending, no need to send an other release. */ if ((sapi_state & MG_REL) > 0) { return; } /* * Are there other contexts using acknowledged mode on the same SAPI? */ for (npi = 0; npi < SNDCP_NUMBER_OF_NSAPIS; npi++) { BOOL used = FALSE; sndcp_is_nsapi_used(npi, &used); if (!used) { continue; } sndcp_get_nsapi_sapi(npi, &spi); if (spi == sapi && npi != nsapi) { BOOL is_ack = FALSE; sndcp_get_nsapi_ack(npi, &is_ack); if (is_ack) { another_ack = TRUE; } break; } } if (!another_ack) { if (((sapi_state & MG_EST) == 0) && ((sapi_state & MG_XID) == 0)) { /* * No LL_ESTABLISH_REQ or LL_XID_REQ pending. * LL_RELEASE_REQ may be sent. */ PALLOC(ll_release_req, LL_RELEASE_REQ); ll_release_req->sapi = sapi; /* * Note: this is always set to TRUE because the preconditions include that * this procedure has been called after an SNSM_DEACTIVATE_IND. * If this precondition changes the local flag will have to be a parameter. * (GSM 4.65, 6.2.2.2). */ ll_release_req->local = TRUE; /* * Set the "state" for the affected sapi to MG_REL. */ sndcp_set_sapi_state(sapi, MG_REL); sndcp_unset_sapi_state(sapi, MG_EST); PSEND(hCommLLC, ll_release_req); } else { /* * LL_ESTABLISH_REQ or LL_XID_REQ pending. * LL_RELEASE_REQ may not be sent. */ sndcp_set_sapi_state(sapi, MG_REL_NEC_LOC); } } /* if (!another_ack) */ } /* mg_rel_nsapi_nec() */ /* +------------------------------------------------------------------------------ | Function : mg_send_empty_xid_req +------------------------------------------------------------------------------ | Description : This procedure sets the pending-states of the affected sapi | and nsapi to MG_XID_PENDING and sends an LL_XID_REQ with | the sapi from the given snsm_activate_ind and an empty XID | block. | | Parameters : the SNSM_ACTIVATE_IND | +------------------------------------------------------------------------------ */ #ifdef SNDCP_UPM_INCLUDED GLOBAL void mg_send_empty_xid_req (T_SN_ACTIVATE_REQ* snsm_activate_ind) #else GLOBAL void mg_send_empty_xid_req (T_SNSM_ACTIVATE_IND* snsm_activate_ind) #endif /*#ifdef SNDCP_UPM_INCLUDED*/ { TRACE_FUNCTION( "mg_send_empty_xid_req" ); { PALLOC_SDU(ll_xid_req, LL_XID_REQ, SNDCP_XID_BLOCK_BIT_LEN); /* * Set sapi in ll_xid_req. */ ll_xid_req->sapi = snsm_activate_ind->sapi; ll_xid_req->sdu.l_buf = 0; /* * Mark sapi as pending. */ sndcp_set_sapi_state(snsm_activate_ind->sapi, MG_XID); /* * Send the XID block to LLC. */ sndcp_unset_sapi_state(ll_xid_req->sapi, MG_XID_NEC); sndcp_set_sapi_state(ll_xid_req->sapi, MG_XID); PSEND(hCommLLC, ll_xid_req); } } /* mg_send_xid_req() */ /* +------------------------------------------------------------------------------ | Function : mg_send_snsm_activate_res +------------------------------------------------------------------------------ | Description : Allocates prim, sets parameters and sends prim | | Parameters : the affected nsapi | +------------------------------------------------------------------------------ */ GLOBAL void mg_send_snsm_activate_res (UBYTE nsapi) { TRACE_FUNCTION( "mg_send_snsm_activate_res" ); { UBYTE sapi_index = 0; UBYTE sapi = 0; #ifdef SNDCP_UPM_INCLUDED PALLOC(snsm_activate_res, SN_ACTIVATE_CNF); #else PALLOC(snsm_activate_res, SNSM_ACTIVATE_RES); #endif /*#ifdef SNDCP_UPM_INCLUDED*/ sndcp_get_nsapi_sapi(nsapi, &sapi); sndcp_get_sapi_index(sapi, &sapi_index); snsm_activate_res->nsapi = nsapi; /* * If nsapi uses data compressor, set dcomp parameter * in snsm_activate_res. */ if (sndcp_data->mg.cur_xid_block[sapi_index].v42.is_set && ((sndcp_data->mg.cur_xid_block[sapi_index].v42.nsapis & (1 << nsapi)) > 0)) { #ifdef SNDCP_UPM_INCLUDED snsm_activate_res->comp_params.dcomp = sndcp_data->mg.cur_xid_block[sapi_index].v42.p0; #else snsm_activate_res->dcomp = sndcp_data->mg.cur_xid_block[sapi_index].v42.p0; #endif /*#ifdef SNDCP_UPM_INCLUDED*/ } else { #ifdef SNDCP_UPM_INCLUDED snsm_activate_res->comp_params.dcomp = 0; #else snsm_activate_res->dcomp = 0; #endif /*#ifdef SNDCP_UPM_INCLUDED*/ } /* * If nsapi uses header compressor, set hcomp parameter * and msid field in snsm_activate_res. */ #ifdef SNDCP_UPM_INCLUDED if (sndcp_data->mg.cur_xid_block[sapi_index].vj.is_set && ((sndcp_data->mg.cur_xid_block[sapi_index].vj.nsapis & (1 << nsapi)) > 0)) { snsm_activate_res->comp_params.msid = sndcp_data->mg.cur_xid_block[sapi_index].vj.s0_m_1 + 1; /* * How is that one negotiated? * Missing in VJ XID block. */ snsm_activate_res->comp_params.hcomp = sndcp_data->mg.cur_xid_block[sapi_index].vj.direction; } else { snsm_activate_res->comp_params.hcomp = 0; snsm_activate_res->comp_params.msid = 0; } PSEND(hCommUPM, snsm_activate_res); #else /*#ifdef SNDCP_UPM_INCLUDED*/ if (sndcp_data->mg.cur_xid_block[sapi_index].vj.is_set && ((sndcp_data->mg.cur_xid_block[sapi_index].vj.nsapis & (1 << nsapi)) > 0)) { snsm_activate_res->msid = sndcp_data->mg.cur_xid_block[sapi_index].vj.s0_m_1 + 1; /* * How is that one negotiated? * Missing in VJ XID block. */ snsm_activate_res->hcomp = sndcp_data->mg.cur_xid_block[sapi_index].vj.direction; } else { snsm_activate_res->hcomp = 0; snsm_activate_res->msid = 0; } PSEND(hCommSM, snsm_activate_res); #endif /*#ifdef SNDCP_UPM_INCLUDED*/ } } /* mg_send_snsm_activate_res() */ /* +------------------------------------------------------------------------------ | Function : mg_send_xid_req +------------------------------------------------------------------------------ | Description : This procedure sets the pending-states of the affected sapi | and nsapi to MG_XID_PENDING and sends an LL_XID_REQ with | parameters set according to the compression informations in | the given snsm_activate_ind and according to constants that | determine the capabilities of the data compression entity. | The part of this procedure that deals with the constant | compressor capabilities is implementation dependent. | | Parameters : the SNSM_ACTIVATE_IND | +------------------------------------------------------------------------------ */ #ifdef SNDCP_UPM_INCLUDED GLOBAL void mg_send_xid_req (T_SN_ACTIVATE_REQ* snsm_activate_ind) #else GLOBAL void mg_send_xid_req (T_SNSM_ACTIVATE_IND* snsm_activate_ind) #endif /*#ifdef SNDCP_UPM_INCLUDED*/ { UBYTE sapi_index = 0; TRACE_FUNCTION( "mg_send_xid_req" ); sndcp_get_sapi_index(snsm_activate_ind->sapi, &sapi_index); { PALLOC_SDU(ll_xid_req, LL_XID_REQ, SNDCP_XID_BLOCK_BIT_LEN); /* * Set sapi in ll_xid_req. */ ll_xid_req->sapi = snsm_activate_ind->sapi; /* * Write data from snsm_activate_ind to service variable req_xid_block. */ mg_set_req_xid_block(snsm_activate_ind); /* * Fill the XID block. Implementation dependent. */ mg_set_xid_params(ll_xid_req->sapi, &ll_xid_req->sdu, sndcp_data->mg.req_xid_block[sapi_index]); /* * Mark the affected sapi as xid pending */ sndcp_set_sapi_state(snsm_activate_ind->sapi, MG_XID); /* * Trace xid block. */ #ifdef SNDCP_TRACE_ALL TRACE_EVENT("outcoming xid block:"); sndcp_trace_sdu(&ll_xid_req->sdu); #endif /* * Send the XID block to LLC. */ sndcp_unset_sapi_state(ll_xid_req->sapi, MG_XID_NEC); sndcp_set_sapi_state(ll_xid_req->sapi, MG_XID); PSEND(hCommLLC, ll_xid_req); } } /* mg_send_xid_req() */ /* +------------------------------------------------------------------------------ | Function : mg_send_xid_req_del +------------------------------------------------------------------------------ | Description : If mg_get_sapi_pntt_rej() or mg_get_sapi_dntt_rej() indicate | that compressors must be removed, this function will | send an LL_XID_REQ which does this, or if an XID is pending, | the information about the rejected compressors will be stored | to new_xid_block and the MG_XID_NEC will be set. | | Parameters : the SNSM_ACTIVATE_IND | +------------------------------------------------------------------------------ */ GLOBAL void mg_send_xid_req_del (UBYTE sapi) { UBYTE sapi_index = 0; UBYTE ntt = 0; T_XID_BLOCK mt_xid_block; /* * Only length of parameter type 0. */ USHORT res_sdu_bit_len = 24; BOOL v42_rej = FALSE; BOOL vj_rej = FALSE; TRACE_FUNCTION( "mg_send_xid_req_del" ); sndcp_reset_xid_block(&mt_xid_block); sndcp_get_sapi_index(sapi, &sapi_index); /* * How long will xid_block be? */ /* * Add the extra space for ntts with nsapis == 0. */ for (ntt = 0; ntt < MG_MAX_ENTITIES; ntt++) { BOOL rej = FALSE; mg_get_sapi_dntt_rej(sapi, ntt, &rej); if (rej) { /* * length of ntt octet and nsapis. */ res_sdu_bit_len += 32; v42_rej = TRUE; /* * Change new_xid_block. */ sndcp_data->mg.new_xid_block[sapi_index].v42.nsapis = 0; sndcp_data->mg.new_xid_block[sapi_index].v42.nsapis_set = TRUE; sndcp_data->mg.new_xid_block[sapi_index].v42.is_set = TRUE; } mg_get_sapi_pntt_rej(sapi, ntt, &rej); if (rej) { /* * length of ntt octet and nsapis. */ res_sdu_bit_len += 32; vj_rej = TRUE; /* * Change req_xid_block. */ sndcp_data->mg.new_xid_block[sapi_index].vj.nsapis = 0; sndcp_data->mg.new_xid_block[sapi_index].vj.nsapis_set = TRUE; sndcp_data->mg.new_xid_block[sapi_index].vj.is_set = TRUE; } } if (v42_rej) { /* * Add length of parameter type and length. */ res_sdu_bit_len += 16; } if (vj_rej) { /* * Add length of parameter type and length. */ res_sdu_bit_len += 16; } if (v42_rej || vj_rej) { USHORT state = MG_IDLE; sndcp_get_sapi_state(sapi, &state); if ((state & MG_XID) == 0) { PALLOC_SDU(ll_xid_req, LL_XID_REQ, res_sdu_bit_len); sndcp_data->mg.req_xid_block[sapi_index] = sndcp_data->mg.new_xid_block[sapi_index]; /* * Set sapi in ll_xid_req. */ ll_xid_req->sapi = sapi; /* * Write data from snsm_activate_ind to service variable req_xid_block. */ sndcp_reset_xid_block(&mt_xid_block); sndcp_reset_xid_block(&sndcp_data->mg.new_xid_block[sapi_index]); /* * Fill the XID block. Implementation dependent. */ mg_set_xid_params(ll_xid_req->sapi, &ll_xid_req->sdu, mt_xid_block); /* * Mark the affected sapi as MG_DEL_XID_PENDING. */ sndcp_set_sapi_state(sapi, MG_XID); /* * Send the XID block to LLC. */ sndcp_unset_sapi_state(sapi, MG_XID_NEC); sndcp_set_sapi_state(ll_xid_req->sapi, MG_XID); PSEND(hCommLLC, ll_xid_req); } else { sndcp_set_sapi_state(sapi, MG_XID_NEC); } } } /* mg_send_xid_req_del() */ /* +------------------------------------------------------------------------------ | Function : mg_set_cur_xid_block +------------------------------------------------------------------------------ | Description : This procedure sets the cur_xid_block service variable | according to the values given in req_xid_block and cnf_xid_block. | It also sets the unassigned, selected, assigned states of the affected | dcomp, pcomp, ntt. | The p bit in the req_xid_block is unset, if affected. | See GSM 4.65, 6.8.2. | | Parameters : the affected sapi | +------------------------------------------------------------------------------ */ GLOBAL void mg_set_cur_xid_block (UBYTE sapi) { UBYTE sapi_index = 0; T_XID_BLOCK* cur_xid_block; T_XID_BLOCK* req_xid_block; T_XID_BLOCK* cnf_xid_block; TRACE_FUNCTION( "mg_set_cur_xid_block" ); sndcp_get_sapi_index(sapi, &sapi_index); cur_xid_block = &sndcp_data->mg.cur_xid_block[sapi_index]; req_xid_block = &sndcp_data->mg.req_xid_block[sapi_index]; cnf_xid_block = &sndcp_data->mg.cnf_xid_block[sapi_index]; /* * SNDCP version has been tested to be SNDCP_XID_VERSION. */ cur_xid_block->version = SNDCP_XID_VERSION; /* * V42bis parameters. */ if (req_xid_block->v42.is_set) { cur_xid_block->v42.is_set = TRUE; cur_xid_block->v42.ntt = req_xid_block->v42.ntt; mg_set_sapi_dntt_state(sapi, req_xid_block->v42.ntt, MG_ASSIGNED); req_xid_block->v42.p_bit = SNDCP_P_BIT_0; /* * Algorithm type and DCOMP are only set in req. */ cur_xid_block->v42.algo_type = req_xid_block->v42.algo_type; cur_xid_block->v42.dcomp = req_xid_block->v42.dcomp; mg_set_sapi_dcomp_state(sapi, req_xid_block->v42.dcomp, MG_ASSIGNED); if (cnf_xid_block->v42.is_set) { if (cnf_xid_block->v42.nsapis_set) { cur_xid_block->v42.nsapis = cnf_xid_block->v42.nsapis; cur_xid_block->v42.nsapis_set = TRUE; } else if (req_xid_block->v42.nsapis_set) { cur_xid_block->v42.nsapis = req_xid_block->v42.nsapis; cur_xid_block->v42.nsapis_set = TRUE; } if (cnf_xid_block->v42.p0_set) { cur_xid_block->v42.p0 = cnf_xid_block->v42.p0; cur_xid_block->v42.p0_set = TRUE; } else if (req_xid_block->v42.p0_set) { cur_xid_block->v42.p0 = req_xid_block->v42.p0; cur_xid_block->v42.p0_set = TRUE; } if (cnf_xid_block->v42.p1_set) { cur_xid_block->v42.p1 = cnf_xid_block->v42.p1; cur_xid_block->v42.p1_set = TRUE; } else if (req_xid_block->v42.p1_set) { cur_xid_block->v42.p1 = req_xid_block->v42.p1; cur_xid_block->v42.p1_set = TRUE; } if (cnf_xid_block->v42.p2_set) { cur_xid_block->v42.p2 = cnf_xid_block->v42.p2; cur_xid_block->v42.p2_set = TRUE; } else if (req_xid_block->v42.p2_set) { cur_xid_block->v42.p2 = req_xid_block->v42.p2; cur_xid_block->v42.p2_set = TRUE; } } else { /* * NOT cnf_xid_block->v42.is_set. */ if (req_xid_block->v42.nsapis_set) { cur_xid_block->v42.nsapis = req_xid_block->v42.nsapis; cur_xid_block->v42.nsapis_set = TRUE; } if (req_xid_block->v42.p0_set) { cur_xid_block->v42.p0 = req_xid_block->v42.p0; cur_xid_block->v42.p0_set = TRUE; } if (req_xid_block->v42.p1_set) { cur_xid_block->v42.p1 = req_xid_block->v42.p1; cur_xid_block->v42.p1_set = TRUE; } if (req_xid_block->v42.p2_set) { cur_xid_block->v42.p2 = req_xid_block->v42.p2; cur_xid_block->v42.p2_set = TRUE; } } } else { /* * NOT req_xid_block->v42.is_set. */ if (cnf_xid_block->v42.is_set) { cur_xid_block->v42.is_set = TRUE; if (cnf_xid_block->v42.nsapis_set) { cur_xid_block->v42.nsapis = cnf_xid_block->v42.nsapis; cur_xid_block->v42.nsapis_set = TRUE; } if (cnf_xid_block->v42.p0_set) { cur_xid_block->v42.p0 = cnf_xid_block->v42.p0; cur_xid_block->v42.p0_set = TRUE; } if (cnf_xid_block->v42.p1_set) { cur_xid_block->v42.p1 = cnf_xid_block->v42.p1; cur_xid_block->v42.p1_set = TRUE; } if (cnf_xid_block->v42.p2_set) { cur_xid_block->v42.p2 = cnf_xid_block->v42.p2; cur_xid_block->v42.p2_set = TRUE; } } else { /* * Req and cnf are not set, cur_xid_block keeps its values. */ } } /* * VJ parameters. */ if (req_xid_block->vj.is_set) { cur_xid_block->vj.is_set = TRUE; cur_xid_block->vj.ntt = req_xid_block->vj.ntt; mg_set_sapi_pntt_state(sapi, req_xid_block->vj.ntt, MG_ASSIGNED); req_xid_block->vj.p_bit = SNDCP_P_BIT_0; /* * Algorithm type and PCOMPs are only set in req. * The direction is only set in req. */ cur_xid_block->vj.algo_type = req_xid_block->vj.algo_type; cur_xid_block->vj.pcomp1 = req_xid_block->vj.pcomp1; mg_set_sapi_pcomp_state(sapi, req_xid_block->vj.pcomp1, MG_ASSIGNED); cur_xid_block->vj.pcomp2 = req_xid_block->vj.pcomp2; mg_set_sapi_pcomp_state(sapi, req_xid_block->vj.pcomp2, MG_ASSIGNED); cur_xid_block->vj.direction = req_xid_block->vj.direction; if (cnf_xid_block->vj.is_set) { if (cnf_xid_block->vj.nsapis_set) { cur_xid_block->vj.nsapis = cnf_xid_block->vj.nsapis; cur_xid_block->vj.nsapis_set = TRUE; } else { cur_xid_block->vj.nsapis = req_xid_block->vj.nsapis; cur_xid_block->vj.nsapis_set = TRUE; } if (cnf_xid_block->vj.s0_m_1_set) { cur_xid_block->vj.s0_m_1 = cnf_xid_block->vj.s0_m_1; cur_xid_block->vj.s0_m_1_set = TRUE; } else { cur_xid_block->vj.s0_m_1 = req_xid_block->vj.s0_m_1; cur_xid_block->vj.s0_m_1_set = TRUE; } } else { if (req_xid_block->vj.nsapis_set) { cur_xid_block->vj.nsapis = req_xid_block->vj.nsapis; cur_xid_block->vj.nsapis_set = TRUE; } if (req_xid_block->vj.s0_m_1_set) { cur_xid_block->vj.s0_m_1 = req_xid_block->vj.s0_m_1; cur_xid_block->vj.s0_m_1_set = TRUE; } } } else { /* * NOT req_xid_block->vj.es_set. */ if (cnf_xid_block->vj.is_set) { cur_xid_block->vj.is_set = TRUE; if (cnf_xid_block->vj.nsapis_set) { cur_xid_block->vj.nsapis = cnf_xid_block->vj.nsapis; cur_xid_block->vj.nsapis_set = TRUE; } if (cnf_xid_block->vj.s0_m_1_set) { cur_xid_block->vj.s0_m_1 = cnf_xid_block->vj.s0_m_1; cur_xid_block->vj.s0_m_1_set = TRUE; } } else { /* * Req and cnf are not set, cur_xid_block keeps it's values. */ } } /* * If nsapis are 0, deactivate compressor. */ if (cur_xid_block->v42.nsapis == 0 || cur_xid_block->v42.nsapis_set == FALSE) { /* * Find the affected compressor entity. */ UBYTE dntt = 0; mg_get_sapi_dcomp_dntt(sapi, req_xid_block->v42.dcomp, &dntt); cur_xid_block->v42.is_set = FALSE; mg_set_sapi_dcomp_state(sapi, req_xid_block->v42.dcomp, MG_UNASSIGNED); mg_set_sapi_dntt_state(sapi, dntt, MG_UNASSIGNED); /* * One compressor less, something like sndcp_data->v42_count--; * should come here! */ } if (cur_xid_block->vj.nsapis == 0 || cur_xid_block->vj.nsapis_set == FALSE) { /* * Find the affected compressor entity. */ UBYTE pntt = 0; mg_get_sapi_pcomp_pntt(sapi, req_xid_block->vj.pcomp1, &pntt); mg_get_sapi_pcomp_pntt(sapi, req_xid_block->vj.pcomp2, &pntt); cur_xid_block->vj.is_set = FALSE; mg_set_sapi_pcomp_state(sapi, req_xid_block->vj.pcomp1, MG_UNASSIGNED); mg_set_sapi_pcomp_state(sapi, req_xid_block->vj.pcomp2, MG_UNASSIGNED); mg_set_sapi_pntt_state(sapi, pntt, MG_UNASSIGNED); /* * One compressor less. */ if (sndcp_data->vj_count > 0) { sndcp_data->vj_count--; } } /* * Send new block to service cia. */ sig_mg_cia_new_xid(cur_xid_block); } /* mg_set_cur_xid_block() */ /* +------------------------------------------------------------------------------ | Function : mg_set_new_xid_block +------------------------------------------------------------------------------ | Description : This procedure reads data from the given snsm_activate_ind and | from the already requested xid block and | writes them to the service variable new_xid_block. | When the pending establishment or xid negotiation is finished | this new_xid_block will be newly evaluated. | | Parameters : | the new SNSM_ACTIVATE_IND | +------------------------------------------------------------------------------ */ #ifdef SNDCP_UPM_INCLUDED GLOBAL void mg_set_new_xid_block (T_SN_ACTIVATE_REQ* snsm_activate_ind) #else GLOBAL void mg_set_new_xid_block (T_SNSM_ACTIVATE_IND* snsm_activate_ind) #endif /*#ifdef SNDCP_UPM_INCLUDED*/ { UBYTE sapi_index = 0; TRACE_FUNCTION( "mg_set_new_xid_block" ); sndcp_get_sapi_index(snsm_activate_ind->sapi, &sapi_index); /* * Set the version number. */ sndcp_data->mg.new_xid_block[sapi_index].version = SNDCP_XID_VERSION; /* * Set the V42.bis parameters, */ #ifdef TI_PS_FF_V42BIS sndcp_data->mg.new_xid_block[sapi_index].v42.is_set = #ifdef SNDCP_UPM_INCLUDED (snsm_activate_ind->comp_params.dcomp != NAS_DCOMP_NEITHER_DIRECT); #else (snsm_activate_ind->dcomp != SNSM_COMP_NEITHER_DIRECT); #endif /*#ifdef SNDCP_UPM_INCLUDED*/ sndcp_data->mg.new_xid_block[sapi_index].v42.p_bit = SNDCP_P_BIT_1; sndcp_data->mg.new_xid_block[sapi_index].v42.ntt = SNDCP_NTT_0; sndcp_data->mg.new_xid_block[sapi_index].v42.algo_type = SNDCP_XID_V42; sndcp_data->mg.new_xid_block[sapi_index].v42.dcomp = SNDCP_DCOMP1; sndcp_data->mg.new_xid_block[sapi_index].v42.nsapis = 1 << (snsm_activate_ind->nsapi); sndcp_data->mg.new_xid_block[sapi_index].v42.nsapis_set = TRUE; #ifdef SNDCP_UPM_INCLUDED sndcp_data->mg.new_xid_block[sapi_index].v42.p0 = snsm_activate_ind->comp_params.dcomp; #else sndcp_data->mg.new_xid_block[sapi_index].v42.p0 = snsm_activate_ind->dcomp; #endif /*#ifdef SNDCP_UPM_INCLUDED*/ sndcp_data->mg.new_xid_block[sapi_index].v42.p0_set = TRUE; /* * Set p1 and p2 to default values. */ sndcp_data->mg.new_xid_block[sapi_index].v42.p1 = SNDCP_V42_DEFAULT_P1; sndcp_data->mg.new_xid_block[sapi_index].v42.p1_set = TRUE; sndcp_data->mg.new_xid_block[sapi_index].v42.p2 = SNDCP_V42_DEFAULT_P2; sndcp_data->mg.new_xid_block[sapi_index].v42.p2_set = TRUE; /* * Set affected entities and dcomp/pcomp values. */ mg_set_ntt_comp(snsm_activate_ind->sapi); #else /* !TI_PS_FF_V42BIS */ sndcp_data->mg.new_xid_block[sapi_index].v42.is_set = FALSE; sndcp_data->mg.new_xid_block[sapi_index].v42.nsapis = 0; sndcp_data->mg.new_xid_block[sapi_index].v42.nsapis_set = FALSE; sndcp_data->mg.new_xid_block[sapi_index].v42.p0_set = FALSE; /* * Set p1 and p2 to default values. */ sndcp_data->mg.new_xid_block[sapi_index].v42.p1 = SNDCP_V42_DEFAULT_P1; sndcp_data->mg.new_xid_block[sapi_index].v42.p1_set = TRUE; sndcp_data->mg.new_xid_block[sapi_index].v42.p2 = SNDCP_V42_DEFAULT_P2; sndcp_data->mg.new_xid_block[sapi_index].v42.p2_set = TRUE; #endif /* TI_PS_FF_V42BIS */ /* * Set the Van Jacobson parameters, */ sndcp_data->mg.new_xid_block[sapi_index].vj.is_set = #ifdef SNDCP_UPM_INCLUDED (snsm_activate_ind->comp_params.hcomp != NAS_HCOMP_OFF) || #else (snsm_activate_ind->hcomp != SNSM_COMP_NEITHER_DIRECT) || #endif /*#ifdef SNDCP_UPM_INCLUDED*/ sndcp_data->mg.new_xid_block[sapi_index].vj.is_set || sndcp_data->mg.req_xid_block[sapi_index].vj.is_set; if (! sndcp_data->mg.req_xid_block[sapi_index].vj.is_set) { sndcp_data->mg.new_xid_block[sapi_index].vj.p_bit = SNDCP_P_BIT_1; } else { sndcp_data->mg.new_xid_block[sapi_index].vj.p_bit = SNDCP_P_BIT_0; } sndcp_data->mg.new_xid_block[sapi_index].vj.ntt = SNDCP_NTT_0; sndcp_data->mg.new_xid_block[sapi_index].vj.algo_type = SNDCP_XID_VJ; sndcp_data->mg.new_xid_block[sapi_index].vj.pcomp1 = SNDCP_PCOMP1; sndcp_data->mg.new_xid_block[sapi_index].vj.pcomp2 = SNDCP_PCOMP2; sndcp_data->mg.new_xid_block[sapi_index].vj.nsapis |= (sndcp_data->mg.req_xid_block[sapi_index].vj.nsapis | 1 << (snsm_activate_ind->nsapi)); sndcp_data->mg.new_xid_block[sapi_index].vj.nsapis_set = TRUE; #ifdef SNDCP_UPM_INCLUDED sndcp_data->mg.new_xid_block[sapi_index].vj.s0_m_1 = snsm_activate_ind->comp_params.msid - 1; #else sndcp_data->mg.new_xid_block[sapi_index].vj.s0_m_1 = snsm_activate_ind->msid - 1; #endif /*#ifdef SNDCP_UPM_INCLUDED*/ sndcp_data->mg.new_xid_block[sapi_index].vj.s0_m_1_set = TRUE; /* * Only used internally, not in XID block. * Not: it is assumed that the indicated values match the existing ones! */ #ifdef SNDCP_UPM_INCLUDED sndcp_data->mg.new_xid_block[sapi_index].vj.direction = snsm_activate_ind->comp_params.hcomp; #else sndcp_data->mg.new_xid_block[sapi_index].vj.direction = snsm_activate_ind->hcomp; #endif /*#ifdef SNDCP_UPM_INCLUDED*/ } /* mg_set_new_xid_block() */ /* +------------------------------------------------------------------------------ | Function : mg_set_req_xid_block +------------------------------------------------------------------------------ | Description : This procedure reads data from the given snsm_activate_ind and | writes it to the service variable req_xid_block. | | Parameters : | the SNSM_ACTIVATE_IND that caused the negotiation. | +------------------------------------------------------------------------------ */ #ifdef SNDCP_UPM_INCLUDED GLOBAL void mg_set_req_xid_block (T_SN_ACTIVATE_REQ* snsm_activate_ind) #else GLOBAL void mg_set_req_xid_block (T_SNSM_ACTIVATE_IND* snsm_activate_ind) #endif /*#ifdef SNDCP_UPM_INCLUDED*/ { UBYTE sapi_index = 0; BOOL vio; TRACE_FUNCTION( "mg_set_req_xid_block" ); sndcp_get_sapi_index(snsm_activate_ind->sapi, &sapi_index); /* * Set the version number. */ sndcp_data->mg.req_xid_block[sapi_index].version = SNDCP_XID_VERSION; /* * Set the V42.bis parameters, */ #ifdef TI_PS_FF_V42BIS #ifdef SNDCP_UPM_INCLUDED sndcp_data->mg.req_xid_block[sapi_index].v42.is_set = (snsm_activate_ind->comp_params.dcomp != NAS_DCOMP_NEITHER_DIRECT); #else sndcp_data->mg.req_xid_block[sapi_index].v42.is_set = (snsm_activate_ind->dcomp != SNSM_COMP_NEITHER_DIRECT); #endif /*#ifdef SNDCP_UPM_INCLUDED*/ sndcp_data->mg.req_xid_block[sapi_index].v42.p_bit = SNDCP_P_BIT_1; sndcp_data->mg.req_xid_block[sapi_index].v42.ntt = SNDCP_NTT_0; sndcp_data->mg.req_xid_block[sapi_index].v42.algo_type = SNDCP_XID_V42; sndcp_data->mg.req_xid_block[sapi_index].v42.dcomp = SNDCP_DCOMP1; sndcp_data->mg.req_xid_block[sapi_index].v42.nsapis = 1 << (snsm_activate_ind->nsapi); sndcp_data->mg.req_xid_block[sapi_index].v42.nsapis_set = TRUE; #ifdef SNDCP_UPM_INCLUDED sndcp_data->mg.req_xid_block[sapi_index].v42.p0 = snsm_activate_ind->comp_params.dcomp; #else sndcp_data->mg.req_xid_block[sapi_index].v42.p0 = snsm_activate_ind->dcomp; #endif /*#ifdef SNDCP_UPM_INCLUDED*/ sndcp_data->mg.req_xid_block[sapi_index].v42.p0_set = TRUE; /* * Set p1 and p2 to default values. */ sndcp_data->mg.req_xid_block[sapi_index].v42.p1 = SNDCP_V42_DEFAULT_P1; sndcp_data->mg.req_xid_block[sapi_index].v42.p1_set = TRUE; sndcp_data->mg.req_xid_block[sapi_index].v42.p2 = SNDCP_V42_DEFAULT_P2; sndcp_data->mg.req_xid_block[sapi_index].v42.p2_set = TRUE; sndcp_data->mg.user_xid_block[snsm_activate_ind->nsapi].v42.is_set = #ifdef SNDCP_UPM_INCLUDED (snsm_activate_ind->comp_params.dcomp != NAS_DCOMP_NEITHER_DIRECT); #else (snsm_activate_ind->dcomp != SNSM_COMP_NEITHER_DIRECT); #endif /*#ifdef SNDCP_UPM_INCLUDED*/ sndcp_data->mg.user_xid_block[snsm_activate_ind->nsapi].v42.p_bit = SNDCP_P_BIT_1; sndcp_data->mg.user_xid_block[snsm_activate_ind->nsapi].v42.ntt = SNDCP_NTT_0; sndcp_data->mg.user_xid_block[snsm_activate_ind->nsapi].v42.algo_type = SNDCP_XID_V42; sndcp_data->mg.user_xid_block[snsm_activate_ind->nsapi].v42.dcomp = SNDCP_DCOMP1; sndcp_data->mg.user_xid_block[snsm_activate_ind->nsapi].v42.nsapis = 1 << (snsm_activate_ind->nsapi); sndcp_data->mg.user_xid_block[snsm_activate_ind->nsapi].v42.nsapis_set = TRUE; #ifdef SNDCP_UPM_INCLUDED sndcp_data->mg.user_xid_block[snsm_activate_ind->nsapi].v42.p0 = snsm_activate_ind->comp_params.dcomp; #else sndcp_data->mg.user_xid_block[snsm_activate_ind->nsapi].v42.p0 = snsm_activate_ind->dcomp; #endif /*#ifdef SNDCP_UPM_INCLUDED*/ sndcp_data->mg.user_xid_block[snsm_activate_ind->nsapi].v42.p0_set = TRUE; /* * Set p1 and p2 to default values. */ sndcp_data->mg.user_xid_block[snsm_activate_ind->nsapi].v42.p1 = SNDCP_V42_DEFAULT_P1; sndcp_data->mg.user_xid_block[snsm_activate_ind->nsapi].v42.p1_set = TRUE; sndcp_data->mg.user_xid_block[snsm_activate_ind->nsapi].v42.p2 = SNDCP_V42_DEFAULT_P2; sndcp_data->mg.user_xid_block[snsm_activate_ind->nsapi].v42.p2_set = TRUE; /* * Set affected entities and dcomp/pcomp values. */ mg_set_ntt_comp(snsm_activate_ind->sapi); #else /* !TI_PS_FF_V42BIS */ sndcp_data->mg.req_xid_block[sapi_index].v42.is_set = FALSE; sndcp_data->mg.req_xid_block[sapi_index].v42.nsapis = 0; sndcp_data->mg.req_xid_block[sapi_index].v42.nsapis_set = FALSE; sndcp_data->mg.req_xid_block[sapi_index].v42.p0_set = FALSE; /* * Set p1 and p2 to default values. */ sndcp_data->mg.req_xid_block[sapi_index].v42.p1 = SNDCP_V42_DEFAULT_P1; sndcp_data->mg.req_xid_block[sapi_index].v42.p1_set = TRUE; sndcp_data->mg.req_xid_block[sapi_index].v42.p2 = SNDCP_V42_DEFAULT_P2; sndcp_data->mg.req_xid_block[sapi_index].v42.p2_set = TRUE; #endif /* TI_PS_FF_V42BIS */ /* * Set the Van Jacobson parameters. * Note: * If number of state slots is set to 0, do not request VJ in XID request. */ #ifdef SNDCP_UPM_INCLUDED if (snsm_activate_ind->comp_params.msid == 0) { #else if (snsm_activate_ind->msid == 0) { #endif /*#ifdef SNDCP_UPM_INCLUDED*/ sndcp_data->mg.req_xid_block[sapi_index].vj.is_set = FALSE; return; } sndcp_data->mg.req_xid_block[sapi_index].vj.is_set = #ifdef SNDCP_UPM_INCLUDED (snsm_activate_ind->comp_params.hcomp != NAS_HCOMP_OFF); #else (snsm_activate_ind->hcomp != SNSM_COMP_NEITHER_DIRECT); #endif /*#ifdef SNDCP_UPM_INCLUDED*/ if (!sndcp_data->mg.req_xid_block[sapi_index].vj.is_set) { return; } /* * This function will only be called after snsm_activate_ind. So the * user_xid_block will be set for the affected nsapi. */ if (sndcp_data->mg.cur_xid_block[sapi_index].vj.is_set) { sndcp_data->mg.user_xid_block[snsm_activate_ind->nsapi].vj.p_bit = SNDCP_P_BIT_0; } else { sndcp_data->mg.user_xid_block[snsm_activate_ind->nsapi].vj.p_bit = SNDCP_P_BIT_1; } sndcp_data->mg.user_xid_block[snsm_activate_ind->nsapi].vj.ntt = SNDCP_NTT_0; sndcp_data->mg.user_xid_block[snsm_activate_ind->nsapi].vj.algo_type = SNDCP_XID_VJ; sndcp_data->mg.user_xid_block[snsm_activate_ind->nsapi].vj.pcomp1 = SNDCP_PCOMP1; sndcp_data->mg.user_xid_block[snsm_activate_ind->nsapi].vj.pcomp2 = SNDCP_PCOMP2; sndcp_data->mg.user_xid_block[snsm_activate_ind->nsapi].vj.nsapis += 1 << (snsm_activate_ind->nsapi); sndcp_data->mg.user_xid_block[snsm_activate_ind->nsapi].vj.nsapis_set = TRUE; #ifdef SNDCP_UPM_INCLUDED if (snsm_activate_ind->comp_params.msid > SNDCP_MAX_NUMBER_OF_VJ_SLOTS) { sndcp_data->mg.user_xid_block[snsm_activate_ind->nsapi].vj.s0_m_1 = SNDCP_MAX_NUMBER_OF_VJ_SLOTS - 1; } else { sndcp_data->mg.user_xid_block[snsm_activate_ind->nsapi].vj.s0_m_1 = snsm_activate_ind->comp_params.msid - 1; } #else if (snsm_activate_ind->msid > SNDCP_MAX_NUMBER_OF_VJ_SLOTS) { sndcp_data->mg.user_xid_block[snsm_activate_ind->nsapi].vj.s0_m_1 = SNDCP_MAX_NUMBER_OF_VJ_SLOTS - 1; } else { sndcp_data->mg.user_xid_block[snsm_activate_ind->nsapi].vj.s0_m_1 = snsm_activate_ind->msid - 1; } #endif /*#ifdef SNDCP_UPM_INCLUDED*/ sndcp_data->mg.user_xid_block[snsm_activate_ind->nsapi].vj.s0_m_1_set = TRUE; /* * Only used internally, not in XID block. */ #ifdef SNDCP_UPM_INCLUDED sndcp_data->mg.user_xid_block[snsm_activate_ind->nsapi].vj.direction = snsm_activate_ind->comp_params.hcomp; #else sndcp_data->mg.user_xid_block[snsm_activate_ind->nsapi].vj.direction = snsm_activate_ind->hcomp; #endif /*#ifdef SNDCP_UPM_INCLUDED*/ /* * Set affected entities and dcomp/pcomp values. */ mg_set_ntt_comp(snsm_activate_ind->sapi); mg_detect_mode_clash ((USHORT) (sndcp_data->mg.cur_xid_block[sapi_index].vj.nsapis + (1 << (snsm_activate_ind->nsapi))), &vio); if (vio) { return; } if (sndcp_data->mg.cur_xid_block[sapi_index].vj.is_set) { sndcp_data->mg.req_xid_block[sapi_index].vj.p_bit = SNDCP_P_BIT_0; } else { sndcp_data->mg.req_xid_block[sapi_index].vj.p_bit = SNDCP_P_BIT_1; } sndcp_data->mg.req_xid_block[sapi_index].vj.ntt = SNDCP_NTT_0; sndcp_data->mg.req_xid_block[sapi_index].vj.algo_type = SNDCP_XID_VJ; sndcp_data->mg.req_xid_block[sapi_index].vj.pcomp1 = SNDCP_PCOMP1; sndcp_data->mg.req_xid_block[sapi_index].vj.pcomp2 = SNDCP_PCOMP2; /* * All the nsapis that currently use the compressor and the new one * shall be set in the nsapis field of the XID block. */ sndcp_data->mg.req_xid_block[sapi_index].vj.nsapis = (sndcp_data->mg.cur_xid_block[sapi_index].vj.nsapis | (1 << (snsm_activate_ind->nsapi))); sndcp_data->mg.req_xid_block[sapi_index].vj.nsapis_set = TRUE; #ifdef SNDCP_UPM_INCLUDED if (snsm_activate_ind->comp_params.msid > SNDCP_MAX_NUMBER_OF_VJ_SLOTS) { sndcp_data->mg.req_xid_block[sapi_index].vj.s0_m_1 = SNDCP_MAX_NUMBER_OF_VJ_SLOTS - 1; } else { sndcp_data->mg.req_xid_block[sapi_index].vj.s0_m_1 = snsm_activate_ind->comp_params.msid - 1; } #else if (snsm_activate_ind->msid > SNDCP_MAX_NUMBER_OF_VJ_SLOTS) { sndcp_data->mg.req_xid_block[sapi_index].vj.s0_m_1 = SNDCP_MAX_NUMBER_OF_VJ_SLOTS - 1; } else { sndcp_data->mg.req_xid_block[sapi_index].vj.s0_m_1 = snsm_activate_ind->msid - 1; } #endif /*#ifdef SNDCP_UPM_INCLUDED*/ sndcp_data->mg.req_xid_block[sapi_index].vj.s0_m_1_set = TRUE; /* * Only used internally, not in XID block. */ #ifdef SNDCP_UPM_INCLUDED sndcp_data->mg.req_xid_block[sapi_index].vj.direction = snsm_activate_ind->comp_params.hcomp; #else sndcp_data->mg.req_xid_block[sapi_index].vj.direction = snsm_activate_ind->hcomp; #endif /*#ifdef SNDCP_UPM_INCLUDED*/ /* * Set affected entities and dcomp/pcomp values. */ mg_set_ntt_comp(snsm_activate_ind->sapi); } /* mg_set_req_xid_block() */ /* +------------------------------------------------------------------------------ | Function : mg_set_res_cur_xid_block +------------------------------------------------------------------------------ | Description : This procedure sets the service variables res_xid_block and | cur_xid_block. The needed data comes from the service variable ind_xid_block, | and from default settings. | Note: if the indicated compressors do not match with compressors requested | or currently used then they will be unset by adding them to the list of | rejected compressors. | | | Parameters : | the affected sapi, | the necessary bit length of an sdu that will later store the | xid block derived from res_xid_block. | +------------------------------------------------------------------------------ */ GLOBAL void mg_set_res_cur_xid_block (UBYTE sapi, USHORT* res_sdu_bit_len) { UBYTE sapi_index = 0; UBYTE nsapi = 0; /* * Which compressors are indicated? */ BOOL v42_ind, vj_ind; /* * Which compressors are possible? * (The indicated set of nsapis must overlap with the * currently used one.) */ BOOL v42_possible, vj_possible; /* * Is compressor going to rejected? In this case the compressor should not * be requested. */ BOOL v42_rejected, vj_rejected; TRACE_FUNCTION( "mg_set_res_cur_xid_block" ); sndcp_get_sapi_index(sapi, &sapi_index); sndcp_reset_xid_block(&(sndcp_data->mg.res_xid_block[sapi_index])); /* * Set bit length to "only version", 3 bytes. */ *res_sdu_bit_len = 24; /* * Set the version number. */ sndcp_data->mg.res_xid_block[sapi_index].version = SNDCP_XID_VERSION; v42_ind = sndcp_data->mg.ind_xid_block[sapi_index].v42.is_set; v42_possible = FALSE; for (nsapi = 0; nsapi < SNDCP_NUMBER_OF_NSAPIS; nsapi++) { if ((sndcp_data->mg.user_xid_block[nsapi].v42.nsapis & sndcp_data->mg.ind_xid_block[sapi_index].v42.nsapis) > 0) { U8 local_sapi = 0; sndcp_get_nsapi_sapi(nsapi, &local_sapi); if (local_sapi == sapi) { v42_possible = TRUE; } } } if (v42_ind && ! v42_possible) { sndcp_data->mg.res_xid_block[sapi_index].v42.is_set = FALSE; mg_set_sapi_dntt_rej (sapi, sndcp_data->mg.ind_xid_block[sapi_index].v42.ntt, TRUE); } mg_get_sapi_dntt_rej (sapi, sndcp_data->mg.ind_xid_block[sapi_index].v42.ntt, &v42_rejected); if (v42_ind && ! v42_rejected) { /* * Data compression will be included, increment bit len (+ 10 bytes). */ *res_sdu_bit_len += 80; /* * Set the V42.bis parameters, */ sndcp_data->mg.res_xid_block[sapi_index].v42.is_set = TRUE; sndcp_data->mg.res_xid_block[sapi_index].v42.p_bit = SNDCP_P_BIT_0; sndcp_data->mg.res_xid_block[sapi_index].v42.ntt = sndcp_data->mg.ind_xid_block[sapi_index].v42.ntt; sndcp_data->mg.res_xid_block[sapi_index].v42.algo_type = SNDCP_XID_V42; sndcp_data->mg.res_xid_block[sapi_index].v42.dcomp = sndcp_data->mg.ind_xid_block[sapi_index].v42.dcomp; /* * Set the 'nsapis' parameter in res_xid_block: * Check rules in 4.65, subclause 6.8.1, compare with cur_xid_block. */ mg_set_xid_nsapis(sapi, MG_XID_V42_NSAPIS); /* * It is assumed that the values desired by the user / the * values possible with the current implementation are written in * req_xid_block, the responded values are then the minimum of * req and ind values: */ /* * For the direction parameter p0 take the logical AND: */ sndcp_data->mg.res_xid_block[sapi_index].v42.p0 = (sndcp_data->mg.req_xid_block[sapi_index].v42.p0 & sndcp_data->mg.ind_xid_block[sapi_index].v42.p0); sndcp_data->mg.res_xid_block[sapi_index].v42.p0_set = TRUE; /* * For p1 and p2 take minimum. */ sndcp_data->mg.res_xid_block[sapi_index].v42.p1 = (sndcp_data->mg.req_xid_block[sapi_index].v42.p1 < sndcp_data->mg.ind_xid_block[sapi_index].v42.p1)? sndcp_data->mg.req_xid_block[sapi_index].v42.p1 : sndcp_data->mg.ind_xid_block[sapi_index].v42.p1; sndcp_data->mg.res_xid_block[sapi_index].v42.p1_set = TRUE; sndcp_data->mg.res_xid_block[sapi_index].v42.p2 = (sndcp_data->mg.req_xid_block[sapi_index].v42.p2 < sndcp_data->mg.ind_xid_block[sapi_index].v42.p2)? sndcp_data->mg.req_xid_block[sapi_index].v42.p2 : sndcp_data->mg.ind_xid_block[sapi_index].v42.p2; sndcp_data->mg.res_xid_block[sapi_index].v42.p2_set = TRUE; } /* v42.is_set */ /* * Header compression, */ vj_ind = sndcp_data->mg.ind_xid_block[sapi_index].vj.is_set; vj_possible = FALSE; for (nsapi = 0; nsapi < SNDCP_NUMBER_OF_NSAPIS; nsapi++) { if ((sndcp_data->mg.user_xid_block[nsapi].vj.nsapis & sndcp_data->mg.ind_xid_block[sapi_index].vj.nsapis) > 0) { U8 local_sapi = 0; sndcp_get_nsapi_sapi(nsapi, &local_sapi); if (local_sapi == sapi) { vj_possible = TRUE; } } } if (vj_ind && ! vj_possible) { sndcp_data->mg.res_xid_block[sapi_index].vj.is_set = FALSE; mg_set_sapi_pntt_rej (sapi, sndcp_data->mg.ind_xid_block[sapi_index].vj.ntt, TRUE); } mg_get_sapi_pntt_rej (sapi, sndcp_data->mg.ind_xid_block[sapi_index].vj.ntt, &vj_rejected); if (vj_ind && ! vj_rejected) { /* * Header compression will be included, increment bit len (+ 7 bytes). */ *res_sdu_bit_len += 56; /* * Set the VJ parameters, */ sndcp_data->mg.res_xid_block[sapi_index].vj.is_set = TRUE; sndcp_data->mg.res_xid_block[sapi_index].vj.p_bit = SNDCP_P_BIT_0; sndcp_data->mg.res_xid_block[sapi_index].vj.ntt = sndcp_data->mg.ind_xid_block[sapi_index].vj.ntt; sndcp_data->mg.res_xid_block[sapi_index].vj.algo_type = SNDCP_XID_VJ; if (sndcp_data->mg.ind_xid_block[sapi_index].vj.p_bit == SNDCP_P_BIT_1) { sndcp_data->mg.res_xid_block[sapi_index].vj.pcomp1 = sndcp_data->mg.ind_xid_block[sapi_index].vj.pcomp1; sndcp_data->mg.res_xid_block[sapi_index].vj.pcomp2 = sndcp_data->mg.ind_xid_block[sapi_index].vj.pcomp2; } else { sndcp_data->mg.res_xid_block[sapi_index].vj.pcomp1 = sndcp_data->mg.cur_xid_block[sapi_index].vj.pcomp1; sndcp_data->mg.res_xid_block[sapi_index].vj.pcomp2 = sndcp_data->mg.cur_xid_block[sapi_index].vj.pcomp2; } /* * Set the 'nsapis' parameter in res_xid_block: * Check rules in 4.65, subclause 6.8.1, compare with cur_xid_block. * State slots and direction are also set here. */ mg_set_xid_nsapis(sapi, MG_XID_VJ_NSAPIS); } /* vj.is_set */ /* * Set affected entities and dcomp/pcomp values. */ if (v42_ind && v42_possible) { mg_set_sapi_dntt_state(sapi, sndcp_data->mg.res_xid_block[sapi_index].v42.ntt, MG_ASSIGNED); mg_set_sapi_dcomp_state(sapi, sndcp_data->mg.res_xid_block[sapi_index].v42.dcomp, MG_ASSIGNED); mg_set_sapi_dcomp_dntt(sapi, sndcp_data->mg.res_xid_block[sapi_index].v42.dcomp, sndcp_data->mg.res_xid_block[sapi_index].v42.ntt); for (nsapi = 0; nsapi < SNDCP_NUMBER_OF_NSAPIS; nsapi++) { if (((1 << nsapi) & sndcp_data->mg.ind_xid_block[sapi_index].v42.nsapis) > 0) { mg_set_sapi_dntt_nsapi(sapi, sndcp_data->mg.res_xid_block[sapi_index].v42.ntt, nsapi, TRUE); } /* if nsapi is selected */ } /* for loop over all nsapis */ } /* * If VJ is indicated and possible, switch on compressor. */ if (vj_ind && vj_possible) { mg_set_sapi_pntt_state(sapi, sndcp_data->mg.res_xid_block[sapi_index].vj.ntt, MG_ASSIGNED); mg_set_sapi_pcomp_state(sapi, sndcp_data->mg.res_xid_block[sapi_index].vj.pcomp1, MG_ASSIGNED); mg_set_sapi_pcomp_state(sapi, sndcp_data->mg.res_xid_block[sapi_index].vj.pcomp2, MG_ASSIGNED); mg_set_sapi_pcomp_pntt(sapi, sndcp_data->mg.res_xid_block[sapi_index].vj.pcomp1, sndcp_data->mg.res_xid_block[sapi_index].vj.ntt); mg_set_sapi_pcomp_pntt(sapi, sndcp_data->mg.res_xid_block[sapi_index].vj.pcomp2, sndcp_data->mg.res_xid_block[sapi_index].vj.ntt); for (nsapi = 0; nsapi < SNDCP_NUMBER_OF_NSAPIS; nsapi++) { if (((1 << nsapi) & sndcp_data->mg.ind_xid_block[sapi_index].v42.nsapis) > 0) { mg_set_sapi_pntt_nsapi(sapi, sndcp_data->mg.res_xid_block[sapi_index].vj.ntt, nsapi, TRUE); } /* if nsapi is selected */ } /* for loop over all nsapis */ } /* * If VJ has been switched on and is now indicated to be switched off: * switch off compressor. */ if (vj_ind && sndcp_data->mg.ind_xid_block[sapi_index].vj.nsapis == 0 && sndcp_data->mg.cur_xid_block[sapi_index].vj.nsapis > 0) { mg_set_sapi_pntt_state(sapi, sndcp_data->mg.res_xid_block[sapi_index].vj.ntt, MG_UNASSIGNED); mg_set_sapi_pcomp_state(sapi, sndcp_data->mg.res_xid_block[sapi_index].vj.pcomp1, MG_UNASSIGNED); mg_set_sapi_pcomp_state(sapi, sndcp_data->mg.res_xid_block[sapi_index].vj.pcomp2, MG_UNASSIGNED); /* mg_set_sapi_pcomp_pntt(sapi, sndcp_data->mg.res_xid_block[sapi_index].vj.pcomp1, sndcp_data->mg.res_xid_block[sapi_index].vj.ntt); mg_set_sapi_pcomp_pntt(sapi, sndcp_data->mg.res_xid_block[sapi_index].vj.pcomp2, sndcp_data->mg.res_xid_block[sapi_index].vj.ntt); */ for (nsapi = 0; nsapi < SNDCP_NUMBER_OF_NSAPIS; nsapi++) { if (((1 << nsapi) & sndcp_data->mg.ind_xid_block[sapi_index].v42.nsapis) > 0) { mg_set_sapi_pntt_nsapi(sapi, sndcp_data->mg.cur_xid_block[sapi_index].vj.ntt, nsapi, FALSE); } /* if nsapi is selected */ } /* for loop over all nsapis */ } /* * Add same values for cur_xid_block. */ if (sndcp_data->mg.res_xid_block[sapi_index].v42.is_set) { if (sndcp_data->mg.cur_xid_block[sapi_index].v42.is_set) { sndcp_data->mg.cur_xid_block[sapi_index].v42.nsapis = sndcp_data->mg.res_xid_block[sapi_index].v42.nsapis; if (sndcp_data->mg.cur_xid_block[sapi_index].v42.p0_set) { sndcp_data->mg.cur_xid_block[sapi_index].v42.p0 = sndcp_data->mg.res_xid_block[sapi_index].v42.p0; } if (sndcp_data->mg.cur_xid_block[sapi_index].v42.p1_set) { sndcp_data->mg.cur_xid_block[sapi_index].v42.p1 = sndcp_data->mg.res_xid_block[sapi_index].v42.p1; } if (sndcp_data->mg.cur_xid_block[sapi_index].v42.p2_set) { sndcp_data->mg.cur_xid_block[sapi_index].v42.p2 = sndcp_data->mg.res_xid_block[sapi_index].v42.p2; } } else { sndcp_data->mg.cur_xid_block[sapi_index].v42 = sndcp_data->mg.res_xid_block[sapi_index].v42; } } if (sndcp_data->mg.res_xid_block[sapi_index].vj.is_set) { if (sndcp_data->mg.cur_xid_block[sapi_index].vj.is_set) { sndcp_data->mg.cur_xid_block[sapi_index].vj.nsapis = sndcp_data->mg.res_xid_block[sapi_index].vj.nsapis; if (sndcp_data->mg.cur_xid_block[sapi_index].vj.s0_m_1_set) { sndcp_data->mg.cur_xid_block[sapi_index].vj.s0_m_1 = sndcp_data->mg.res_xid_block[sapi_index].vj.s0_m_1; } } else { sndcp_data->mg.cur_xid_block[sapi_index].vj = sndcp_data->mg.res_xid_block[sapi_index].vj; } } if (vj_rejected) { sndcp_data->mg.cur_xid_block[sapi_index].vj.nsapis = 0; } if (sndcp_data->mg.cur_xid_block[sapi_index].vj.nsapis == 0) { sndcp_data->mg.cur_xid_block[sapi_index].vj.is_set = FALSE; } if (v42_rejected) { sndcp_data->mg.cur_xid_block[sapi_index].v42.nsapis = 0; } if (sndcp_data->mg.cur_xid_block[sapi_index].v42.nsapis == 0) { sndcp_data->mg.cur_xid_block[sapi_index].v42.is_set = FALSE; } sig_mg_cia_new_xid(& sndcp_data->mg.cur_xid_block[sapi_index]); } /* mg_set_res_cur_xid_block */ /* +------------------------------------------------------------------------------ | Function : mg_set_res_xid_params +------------------------------------------------------------------------------ | Description : This procedure fills the XID block. It is implementation | dependent. In the current version V42bis and VanJacobson | header compression are applied. | | Parameters : | the sdu that will be filled, | Post : Reset arrays with reject information to all FALSE. | +------------------------------------------------------------------------------ */ GLOBAL void mg_set_res_xid_params (T_sdu* sdu, UBYTE sapi) { /* * Byte index in destination sdu. */ UBYTE index = 3; UBYTE type_2_header_index = 0; UBYTE sapi_index = 0; UBYTE ntt = 0; BOOL type_1_header_set = FALSE; BOOL type_2_header_set = FALSE; TRACE_FUNCTION( "mg_set_res_xid_params" ); sndcp_get_sapi_index(sapi, &sapi_index); /* * Set the values for parameter type 0 (version number). */ sdu->buf[0] = SNDCP_XID_PARAM_TYPE_0; /*lint -e{415} (Warning -- access of out-of-bounds pointer)*/ sdu->buf[1] = SNDCP_XID_0_LEN; /*lint -e{415, 416} (Warning -- access/creation of out-of-bounds pointer)*/ sdu->buf[2] = sndcp_data->mg.res_xid_block[sapi_index].version; sdu->l_buf = 3 * 8; sdu->o_buf = 0; /* * Set the values for data compression, if necessary. */ /*lint -e{415, 416} (Warning -- access/creation of out-of-bounds pointer)*/ if (sndcp_data->mg.res_xid_block[sapi_index].v42.is_set) { sdu->buf[3] = SNDCP_XID_PARAM_TYPE_1; sdu->buf[4] = SNDCP_XID_1_LEN_RES; sdu->buf[5] = (UBYTE)(sndcp_data->mg.res_xid_block[sapi_index].v42.p_bit << 7) + sndcp_data->mg.res_xid_block[sapi_index].v42.ntt; sdu->buf[6] = SNDCP_XID_V42_LEN_RES; sdu->buf[7] = (UBYTE)(sndcp_data->mg.res_xid_block[sapi_index].v42.nsapis >> 8); sdu->buf[8] = (UBYTE)(sndcp_data->mg.res_xid_block[sapi_index].v42.nsapis & 0xff); sdu->buf[9] = sndcp_data->mg.res_xid_block[sapi_index].v42.p0; sdu->buf[10] = (UBYTE)(sndcp_data->mg.res_xid_block[sapi_index].v42.p1 >> 8); sdu->buf[11] = (UBYTE)(sndcp_data->mg.res_xid_block[sapi_index].v42.p1 & 0xff); sdu->buf[12] = sndcp_data->mg.res_xid_block[sapi_index].v42.p2; index = 13; sdu->l_buf = 13 * 8; type_1_header_set = TRUE; } /* * Add rejected data compression entities. */ for (ntt = 0; ntt < MG_MAX_ENTITIES; ntt++) { BOOL rej = FALSE; mg_get_sapi_dntt_rej(sapi, ntt, &rej); /*lint -e{661, 662} (Warning -- Possible access/creation of out-of-bounds pointer)*/ if (rej) { if (! type_1_header_set) { sdu->buf[index] = SNDCP_XID_PARAM_TYPE_1; index++; sdu->buf[index] = 0; index++; type_1_header_set = TRUE; sdu->l_buf += 16; } sdu->buf[index] = ntt; index++; /* * Length of field. */ sdu->buf[index] = 2; index++; /* * Set 2 'nsapis' octets to 0. */ sdu->buf[index] = 0; index++; sdu->buf[index] = 0; index++; /* * Increment sdu length. */ sdu->l_buf = sdu->l_buf + 32; /* * Increment parameter type 1 length octet. */ /*lint -e{415, 416} (Warning -- access/creation of out-of-bounds pointer)*/ sdu->buf[4] += 4; } } type_2_header_index = index; /* * Set the values for header compression, if requested. */ /*lint -e{661, 662} (Warning -- Possible access/creation of out-of-bounds pointer)*/ if (sndcp_data->mg.res_xid_block[sapi_index].vj.is_set) { sdu->buf[index] = SNDCP_XID_PARAM_TYPE_2; index++; sdu->buf[index] = SNDCP_XID_2_LEN_RES; index++; sdu->buf[index] = (UBYTE)(sndcp_data->mg.res_xid_block[sapi_index].vj.p_bit << 7) + sndcp_data->mg.res_xid_block[sapi_index].vj.ntt; index++; sdu->buf[index] = SNDCP_XID_VJ_LEN_RES; index++; sdu->buf[index] = (UBYTE)(sndcp_data->mg.res_xid_block[sapi_index].vj.nsapis >> 8); index++; sdu->buf[index] = (UBYTE)(sndcp_data->mg.res_xid_block[sapi_index].vj.nsapis & 0xff); index++; sdu->buf[index] = sndcp_data->mg.res_xid_block[sapi_index].vj.s0_m_1; index++; sdu->l_buf = sdu->l_buf + 7 * 8; type_2_header_set = TRUE; } /* * Add rejected header compression entities. */ /*lint -e{661, 662} (Warning -- Possible access/creation of out-of-bounds pointer)*/ for (ntt = 0; ntt < MG_MAX_ENTITIES; ntt++) { BOOL rej = FALSE; mg_get_sapi_pntt_rej(sapi, ntt, &rej); if (rej) { if (! type_2_header_set) { sdu->buf[index] = SNDCP_XID_PARAM_TYPE_2; index++; sdu->buf[index] = 0; index++; type_2_header_set = TRUE; sdu->l_buf += 16; } sdu->buf[index] = ntt; index++; /* * Length of field. */ sdu->buf[index] = 2; index++; /* * Set 2 'nsapis' octets to 0. */ sdu->buf[index] = 0; index++; sdu->buf[index] = 0; index++; /* * Increment sdu length. */ sdu->l_buf = sdu->l_buf + 32; /* * Increment parameter type 2 length octet. */ sdu->buf[type_2_header_index + 1] += 4; } } /* * Set sdu offset to 0. */ sdu->o_buf = 0; /* * Reset the arrays with rejected params to all FALSE. */ for (ntt = 0; ntt < MG_MAX_ENTITIES; ntt++) { sndcp_data->mg.sapi_dntt_rej_ra[sapi_index][ntt] = FALSE; sndcp_data->mg.sapi_pntt_rej_ra[sapi_index][ntt] = FALSE; } } /* mg_set_res_xid_params() */ /* +------------------------------------------------------------------------------ | Function : mg_set_xid_params +------------------------------------------------------------------------------ | Description : This procedure fills the XID block. It is implementation | dependent. In the current version V42bis and VanJacobson | header compression are applied. | | Parameters : | sapi and sdu from the LL_XID_REQ that will be filled and | xid_block that defines the desired compressors | +------------------------------------------------------------------------------ */ GLOBAL void mg_set_xid_params (UBYTE sapi, T_sdu* sdu, T_XID_BLOCK xid_block) { /* * Byte index in destination sdu. */ UBYTE index = 3; UBYTE sapi_index = 0; UBYTE ntt = 0; BOOL type_1_header_set = FALSE; BOOL type_2_header_set = FALSE; UBYTE type_2_header_index = 0; UBYTE type_1_header_index = 3; USHORT p1 = SNDCP_V42_DEFAULT_P1; TRACE_FUNCTION( "mg_set_xid_params" ); sndcp_get_sapi_index(sapi, &sapi_index); /* * Set the values for parameter type 0 (version number). */ sdu->buf[0] = SNDCP_XID_PARAM_TYPE_0; /*lint -e{415} (Warning -- access of out-of-bounds pointer)*/ sdu->buf[1] = SNDCP_XID_0_LEN; /*lint -e{415, 416} (Warning -- access/creation of out-of-bounds pointer)*/ sdu->buf[2] = SNDCP_XID_VERSION; sdu->l_buf = 24; /* 3 * 8 */ sdu->o_buf = 0; /* * Set the values for data compression, if necessary. */ /*lint -e{415, 416} (Warning -- access/creation of out-of-bounds pointer)*/ if (xid_block.v42.is_set && #ifdef SNDCP_UPM_INCLUDED xid_block.v42.p0 != NAS_DCOMP_OFF && #else xid_block.v42.p0 != SNSM_COMP_NEITHER_DIRECT && #endif /*#ifdef SNDCP_UPM_INCLUDED*/ xid_block.v42.nsapis_set && xid_block.v42.nsapis > 0) { if (xid_block.v42.p_bit > 0) { sdu->buf[3] = SNDCP_XID_PARAM_TYPE_1; sdu->buf[4] = SNDCP_XID_1_LEN; sdu->buf[5] = (UBYTE)(xid_block.v42.p_bit << 7) + xid_block.v42.ntt; sdu->buf[6] = xid_block.v42.algo_type; sdu->buf[7] = SNDCP_XID_V42_LEN; sdu->buf[8] = (UBYTE)(xid_block.v42.dcomp << 4); sdu->buf[9] = (UBYTE)(xid_block.v42.nsapis >> 8); sdu->buf[10] = (UBYTE)(xid_block.v42.nsapis & 0xff); sdu->buf[11] = xid_block.v42.p0; /* * P1, P2 */ sdu->buf[12] = (p1 & 0xff00) >> 8; sdu->buf[13] = p1 & 0x00ff; sdu->buf[14] = SNDCP_V42_DEFAULT_P2; index = 15; sdu->l_buf = 15 * 8; } else { sdu->buf[3] = SNDCP_XID_PARAM_TYPE_1; sdu->buf[4] = SNDCP_XID_1_LEN_RES; sdu->buf[5] = xid_block.v42.ntt; sdu->buf[6] = SNDCP_XID_V42_LEN_RES; sdu->buf[7] = (UBYTE)(xid_block.v42.nsapis >> 8); sdu->buf[8] = (UBYTE)(xid_block.v42.nsapis & 0xff); sdu->buf[9] = xid_block.v42.p0; /* * P1, P2 */ sdu->buf[10] = (p1 & 0xff00) >> 8; sdu->buf[11] = p1 & 0x00ff; sdu->buf[12] = SNDCP_V42_DEFAULT_P2; index = 13; sdu->l_buf = 13 * 8; } } type_2_header_index = index; /* * Set the values for header compression, if requested. */ /*lint -e{661, 662} (Warning -- Possible access/creation of out-of-bounds pointer)*/ if (xid_block.vj.is_set && #ifdef SNDCP_UPM_INCLUDED xid_block.vj.direction != NAS_HCOMP_OFF && #else xid_block.vj.direction != SNSM_COMP_NEITHER_DIRECT && #endif /*#ifdef SNDCP_UPM_INCLUDED*/ xid_block.vj.nsapis_set && xid_block.vj.nsapis > 0) { if (xid_block.vj.p_bit > 0) { sdu->buf[index] = SNDCP_XID_PARAM_TYPE_2; sdu->buf[index + 1] = SNDCP_XID_2_LEN; sdu->buf[index + 2] = (UBYTE)(xid_block.vj.p_bit << 7) + xid_block.vj.ntt; sdu->buf[index + 3] = SNDCP_XID_VJ; sdu->buf[index + 4] = SNDCP_XID_VJ_LEN; sdu->buf[index + 5] = (UBYTE)(xid_block.vj.pcomp1 << 4) + xid_block.vj.pcomp2; sdu->buf[index + 6] = (UBYTE)(xid_block.vj.nsapis >> 8); sdu->buf[index + 7] = (UBYTE)(xid_block.vj.nsapis & 0xff); sdu->buf[index + 8] = xid_block.vj.s0_m_1; sdu->l_buf = sdu->l_buf + 9 * 8; type_2_header_set = TRUE; } else { sdu->buf[index] = SNDCP_XID_PARAM_TYPE_2; sdu->buf[index + 1] = SNDCP_XID_2_LEN_RES; sdu->buf[index + 2] = xid_block.vj.ntt; sdu->buf[index + 3] = SNDCP_XID_VJ_LEN_RES; sdu->buf[index + 4] = (UBYTE)(xid_block.vj.nsapis >> 8); sdu->buf[index + 5] = (UBYTE)(xid_block.vj.nsapis & 0xff); sdu->buf[index + 6] = xid_block.vj.s0_m_1; sdu->l_buf = sdu->l_buf + 7 * 8; type_2_header_set = TRUE; } } /* * Add rejected data compression entities. */ /*lint -e{661, 662} (Warning -- Possible access/creation of out-of-bounds pointer)*/ for (ntt = 0; ntt < MG_MAX_ENTITIES; ntt++) { BOOL rej = FALSE; mg_get_sapi_dntt_rej(sapi, ntt, &rej); if (rej) { if (! type_1_header_set) { sdu->buf[index] = SNDCP_XID_PARAM_TYPE_1; index++; sdu->buf[index] = 0; index++; type_1_header_set = TRUE; sdu->l_buf += 16; } sdu->buf[index] = ntt; index++; /* * Length of field. */ sdu->buf[index] = 2; index++; /* * Set 2 'nsapis' octets to 0. */ sdu->buf[index] = 0; index++; sdu->buf[index] = 0; index++; /* * Increment sdu length. */ sdu->l_buf = sdu->l_buf + 32; /* * Increment parameter type 2 length octet. */ /*lint -e{415, 416} (Warning -- access/creation of out-of-bounds pointer)*/ sdu->buf[type_1_header_index + 1] += 4; } } /* for (ntt = 0; ntt < MG_MAX_ENTITIES; ntt++) */ /* * Add rejected header compression entities. */ /*lint -e{661, 662} (Warning -- Possible access/creation of out-of-bounds pointer)*/ for (ntt = 0; ntt < MG_MAX_ENTITIES; ntt++) { BOOL rej = FALSE; mg_get_sapi_pntt_rej(sapi, ntt, &rej); if (rej) { if (! type_2_header_set) { sdu->buf[index] = SNDCP_XID_PARAM_TYPE_2; index++; sdu->buf[index] = 0; index++; type_2_header_set = TRUE; sdu->l_buf += 16; } sdu->buf[index] = ntt; index++; /* * Length of field. */ sdu->buf[index] = 2; index++; /* * Set 2 'nsapis' octets to 0. */ sdu->buf[index] = 0; index++; sdu->buf[index] = 0; index++; /* * Increment sdu length. */ sdu->l_buf = sdu->l_buf + 32; /* * Increment parameter type 2 length octet. */ sdu->buf[type_2_header_index + 1] += 4; } } /* for (ntt = 0; ntt < MG_MAX_ENTITIES; ntt++) */ /* * Set sdu offset to 0. */ sdu->o_buf = 0; /* * Reset the arrays with rejected params to all FALSE. */ for (ntt = 0; ntt < MG_MAX_ENTITIES; ntt++) { sndcp_data->mg.sapi_dntt_rej_ra[sapi_index][ntt] = FALSE; sndcp_data->mg.sapi_pntt_rej_ra[sapi_index][ntt] = FALSE; } } /* mg_set_xid_params() */ /* +------------------------------------------------------------------------------ | Function : mg_del_comp_pdus_ack +------------------------------------------------------------------------------ | Description : The function mg_del_comp_pdus_ack() | GSM 4.65, 5.1.2.7: | "compressed N-PDUs queuing to be forwarded to the affected | SAPI are deleted from the SNDCP layer." | Assumption: It is assumed here that acknowledged and | unacknowledged npdus are deleted the same. | | Parameters : UBYTE sapi: the affected sapi | +------------------------------------------------------------------------------ */ GLOBAL void mg_del_comp_pdus_ack (UBYTE sapi) { UBYTE nsapi = 0; TRACE_FUNCTION( "mg_del_comp_pdus_ack" ); for (nsapi = 0; nsapi < SNDCP_NUMBER_OF_NSAPIS; nsapi++) { UBYTE sp = 0; sndcp_get_nsapi_sapi(nsapi, &sp); if (sp == sapi) { sig_mg_cia_delete_npdus(nsapi); sig_mg_su_delete_pdus(nsapi, sapi); sig_mg_sua_delete_pdus(nsapi, sapi, TRUE); sig_mg_sd_delete_npdus(nsapi, sapi); sig_mg_sda_delete_npdus(nsapi, sapi); } } } /* mg_del_comp_pdus_ack() */ /* +------------------------------------------------------------------------------ | Function : mg_delete_npdus +------------------------------------------------------------------------------ | Description : The function mg_delete_npdus() sends signals to all affected | services to delete the buffered npdus. | | Parameters : UBYTE nsapi: the affected nsapi | +------------------------------------------------------------------------------ */ GLOBAL void mg_delete_npdus (UBYTE nsapi) { UBYTE sapi = 0; TRACE_FUNCTION( "mg_delete_npdus" ); sndcp_get_nsapi_sapi(nsapi, &sapi); sig_mg_cia_delete_npdus(nsapi); sig_mg_su_delete_pdus(nsapi, sapi); sig_mg_sua_delete_pdus(nsapi, sapi, TRUE); sig_mg_sd_delete_npdus(nsapi, sapi); sig_mg_sda_delete_npdus(nsapi, sapi); sig_mg_nu_delete_npdus(nsapi); } /* mg_delete_npdus() */ /* +------------------------------------------------------------------------------ | Function : mg_suspend_affected_nus +------------------------------------------------------------------------------ | Description : Suspends all nu service instances affected by XID negotiation | Sets service variable 'suspended_nsapis'. | | Parameters : sapi | +------------------------------------------------------------------------------ */ GLOBAL void mg_suspend_affected_nus (UBYTE sapi) { UBYTE nsapi = 0; UBYTE sapi_index = 0; TRACE_FUNCTION( "mg_resume_affected_nus" ); sndcp_get_sapi_index(sapi, &sapi_index); for (nsapi = 0; nsapi < SNDCP_NUMBER_OF_NSAPIS; nsapi++) { if (1 << nsapi & sndcp_data->mg.req_xid_block[sapi_index].vj.nsapis || 1 << nsapi & sndcp_data->mg.cur_xid_block[sapi_index].vj.nsapis || 1 << nsapi & sndcp_data->mg.req_xid_block[sapi_index].v42.nsapis || 1 << nsapi & sndcp_data->mg.cur_xid_block[sapi_index].v42.nsapis) { sndcp_data->mg.suspended_nsapis |= (1 << nsapi); sig_mg_nu_suspend(nsapi); } } } /* mg_suspend_affected_nus() */ /* * Getters and setters for the organizing arrays. */ /* +------------------------------------------------------------------------------ | Function : mg_get_sapi_dntt_rej +------------------------------------------------------------------------------ | Description : The procedures informs about if a given data | compression entity on a given SAPI is to be rejected in | LL_XID_REQ because it cannot be set up. | | Parameters : FPAR IN sapi UBYTE, | IN dntt UBYTE, | IN/OUT rej BOOL | +------------------------------------------------------------------------------ */ GLOBAL void mg_get_sapi_dntt_rej (UBYTE sapi, UBYTE dntt, BOOL* rej) { TRACE_FUNCTION( "mg_get_sapi_dntt_rej" ); { UBYTE sapi_index = 0; sndcp_get_sapi_index(sapi, &sapi_index); *rej = sndcp_data->mg.sapi_dntt_rej_ra[sapi_index][dntt]; } } /* mg_get_sapi_dntt_rej() */ /* +------------------------------------------------------------------------------ | Function : mg_get_sapi_pntt_rej +------------------------------------------------------------------------------ | Description : The procedures informs about if a given header | compression entity on a given SAPI is to be rejected in | LL_XID_REQ because it cannot be set up. | | Parameters : FPAR IN sapi UBYTE, | IN pntt UBYTE, | IN/OUT rej BOOL | +------------------------------------------------------------------------------ */ GLOBAL void mg_get_sapi_pntt_rej (UBYTE sapi, UBYTE pntt, BOOL* rej) { TRACE_FUNCTION( "mg_get_sapi_pntt_rej" ); { UBYTE sapi_index = 0; sndcp_get_sapi_index(sapi, &sapi_index); *rej = sndcp_data->mg.sapi_pntt_rej_ra[sapi_index][pntt]; } } /* mg_get_sapi_pntt_rej() */ /* +------------------------------------------------------------------------------ | Function : mg_get_sapi_pntt_nsapi +------------------------------------------------------------------------------ | Description : The procedure informs if a given nsapi uses a given pntt on a | given sapi. | | Parameters : FPAR IN sapi UBYTE, | IN pntt UBYTE, | IN nsapi UBYTE, | IN/OUT used BOOL | +------------------------------------------------------------------------------ */ GLOBAL void mg_get_sapi_pntt_nsapi (UBYTE sapi, UBYTE pntt, UBYTE nsapi, BOOL* used) { TRACE_FUNCTION( "mg_get_sapi_pntt_nsapi" ); { UBYTE sapi_index = 0; sndcp_get_sapi_index(sapi, &sapi_index); *used = sndcp_data->mg.sapi_pntt_nsapi_set_ra[sapi_index][pntt][nsapi]; } } /* mg_get_sapi_pntt_nsapi() */ /* +------------------------------------------------------------------------------ | Function : mg_get_sapi_pcomp_pntt +------------------------------------------------------------------------------ | Description : The procedures indicates the pntt assigned to a given pcomp | for a given sapi. | | Parameters : FPAR IN sapi UBYTE, | IN pcomp UBYTE, | IN/OUT dntt UBYTE | +------------------------------------------------------------------------------ */ GLOBAL void mg_get_sapi_pcomp_pntt (UBYTE sapi, UBYTE pcomp, UBYTE* pntt) { TRACE_FUNCTION( "mg_get_sapi_pcomp_pntt" ); { UBYTE sapi_index = 0; sndcp_get_sapi_index(sapi, &sapi_index); *pntt = sndcp_data->mg.sapi_pcomp_pntt_ra[sapi_index][pcomp]; } } /* mg_get_sapi_pcomp_pntt() */ /* +------------------------------------------------------------------------------ | Function : mg_xid_cnf_ok_res +------------------------------------------------------------------------------ | Description : | After an LL_XID_REQ has been sent there are contexts in state MG_XID. | These are now reset after reception of the LL_XID_CNF. | The "applicable nsapis" in req_xid_block.v42 and req_xid_block.vj, each one | only once. | SIG_MG_NU_RESET(nsapi, discard_ready) is used. | In every nu instance: N-PDU number is set to 0 for this instance and an | SN_UNITREADY_IND is sent. State is set to NU_UNACK_SU_RECEPTIVE | Then the SNSM_ACTIVATE_RES is sent for each one of these. | | Parameters : affected sapi | +------------------------------------------------------------------------------ */ GLOBAL void mg_xid_cnf_ok_res (UBYTE sapi) { UBYTE nsapi = 0; TRACE_FUNCTION( "mg_xid_cnf_ok_res" ); for (nsapi = 0; nsapi < SNDCP_NUMBER_OF_NSAPIS; nsapi++) { USHORT nsapi_state = MG_IDLE; USHORT sapi_state = MG_IDLE; UBYTE sapi_index = 0; UBYTE func_sapi = 0; sndcp_get_nsapi_sapi(nsapi, &func_sapi); if (func_sapi != sapi) { continue; } sndcp_get_sapi_index(sapi, &sapi_index); sndcp_get_nsapi_state(nsapi, &nsapi_state); sndcp_get_sapi_state(func_sapi, &sapi_state); if (((sapi_state & MG_XID_NEC) > 0) && ((sapi_state & MG_REL) == 0)) { mg_resend_xid_if_nec(sapi); sndcp_get_sapi_state(func_sapi, &sapi_state); /* * If now XID is sent, no further actions for this nsapi. */ if ((sapi_state & MG_XID) > 0) { continue; } } else if ((nsapi_state & MG_ACT) > 0 && (sapi_state & MG_EST) == 0) { BOOL ack = FALSE; sndcp_get_nsapi_ack(nsapi, &ack); /* * Open DTI connection. */ #ifndef SNDCP_UPM_INCLUDED mg_dti_open(nsapi); #endif if (ack) { sig_mg_nu_reset_ack(nsapi, 0, 0, FALSE); sig_mg_sda_getdata(sapi, nsapi); } else { sig_mg_nu_reset(nsapi, FALSE); sig_mg_sd_getunitdata(sapi, nsapi); } if ((sapi_state & MG_XID) == 0) { mg_send_snsm_activate_res(nsapi); /* * Set nsapi state to MG_IDLE. */ sndcp_unset_nsapi_state(nsapi, MG_ACT); } } /* if state is MG_ACT and not MG_EST */ if ((nsapi_state & MG_DEACT) > 0) { USHORT local_sapi_state = MG_IDLE; sndcp_get_sapi_state(sapi, &local_sapi_state); if ((local_sapi_state & (MG_REL_NEC_LOC + MG_REL_NEC_PEER + MG_XID_NEC + MG_XID)) == 0) { /* * No LL_RELEASE_REQ necessary. Notify sndcp. */ #ifdef SNDCP_UPM_INCLUDED PALLOC(snsm_deactivate_res, SN_DEACTIVATE_CNF); #else PALLOC(snsm_deactivate_res, SNSM_DEACTIVATE_RES); #endif /*#ifdef SNDCP_UPM_INCLUDED*/ /* * Now the NSAPI is not in use anymore: */ sndcp_set_nsapi_used(nsapi, FALSE); sndcp_set_nsapi_ack(nsapi, FALSE); snsm_deactivate_res->nsapi = nsapi; sndcp_unset_nsapi_state(nsapi, MG_DEACT); #ifdef SNDCP_UPM_INCLUDED PSEND(hCommUPM, snsm_deactivate_res); #else PSEND(hCommSM, snsm_deactivate_res); #endif /*#ifdef SNDCP_UPM_INCLUDED*/ /* * Resume nsapi. */ mg_resume_affected_nus(sapi); } else if ((local_sapi_state & (MG_REL_NEC_LOC + MG_REL_NEC_PEER)) > 0) { /* * LL_RELEASE_REQ must be sent. */ PALLOC(ll_release_req, LL_RELEASE_REQ); sndcp_unset_sapi_state(sapi, MG_REL_NEC_LOC); ll_release_req->sapi = sapi; ll_release_req->local = TRUE; /* * Set the "state" for the affected and sapi to MG_REL_PENDING. */ sndcp_set_sapi_state(sapi, MG_REL); PSEND(hCommLLC, ll_release_req); } else { UBYTE local_sapi = 0; UBYTE local_nsapi = 0; BOOL local_nec = FALSE; for (local_nsapi = 0; local_nsapi < SNDCP_NUMBER_OF_NSAPIS; local_nsapi++) { sndcp_get_nsapi_sapi(local_nsapi, &local_sapi); if (sapi == local_sapi) { /* * is compressor deactivation necessary? */ sndcp_get_nsapi_state(local_nsapi, &nsapi_state); if ((nsapi_state & MG_DEACT) > 0) { mg_is_rel_comp_nec(local_nsapi, &local_nec); } } } /* * Negotiate possible deactivation of compressors. */ if (local_nec) { mg_send_xid_req_del(sapi); } } } } } /* mg_xid_cnf_ok_res */ #ifdef TI_DUAL_MODE /* +------------------------------------------------------------------------------ | Function : mg_get_unsent_unconfirmed_npdus +------------------------------------------------------------------------------ | Description : This procedure retrieves any unsent or unconfirmed acknowledged | NPDU from SNDCP's internal buffers. ANY retrieved NPDU is packed | the primitive SN_GET_PENDING_PDU_CNF data. | | Parameters : nsapi, pointer to the primitive. | +------------------------------------------------------------------------------ */ GLOBAL T_SN_GET_PENDING_PDU_CNF* mg_get_unsent_unconfirmed_npdus (U8 nsapi, T_SN_GET_PENDING_PDU_CNF* sn_get_pending_pdu_cnf) { int count = 0; U8 used_sapi=0, sapi_index=0; T_NPDU_BUFFER* help = NULL; TRACE_FUNCTION( "mg_get_unsent_unconfirmed_npdus" ); /* * set service instance according to nsapi in primitive */ sndcp_data->nu = & sndcp_data->nu_base[nsapi]; /* * Find number of unconfirmed NPDUs */ help = sndcp_data->nu->first_buffered_npdu; while(help != NULL) { count++; help = help->next; } sn_get_pending_pdu_cnf->ul_pdus[nsapi].ptr_desc_list2 = (T_SN_desc_list2*)DRP_ALLOC( count * sizeof( T_SN_desc_list2 ), 0 ); sn_get_pending_pdu_cnf->ul_pdus[nsapi].nsapi = nsapi; sn_get_pending_pdu_cnf->ul_pdus[nsapi].dl_sequence_number = sndcp_data->nu->rec_npdu_number_ack; sn_get_pending_pdu_cnf->ul_pdus[nsapi].c_desc_list2 = count; count = 0; /* * Check if there are buffered any acknowledged type NPDUs. */ help = sndcp_data->nu->first_buffered_npdu; while(help != NULL) { sn_get_pending_pdu_cnf->ul_pdus[nsapi].ptr_desc_list2[count].first = help->sn_data_req->desc_list2.first; sn_get_pending_pdu_cnf->ul_pdus[nsapi].ptr_desc_list2[count].list_len = help->sn_data_req->desc_list2.list_len; count++; help = help->next; } return sn_get_pending_pdu_cnf; } /* +------------------------------------------------------------------------------ | Function : mg_clean_ack_npdu_queues_leave_data +------------------------------------------------------------------------------ | Description : This procedure deletes SNDCP's internal buffers containing | unconfirmed acknowledged type NPDU's. | The data stored in the queues are not deleted. | | Parameters : nsapi | +------------------------------------------------------------------------------ */ GLOBAL void mg_clean_ack_npdu_queues_leave_data(U8 nsapi) { U8 used_sapi=0, sapi_index=0; T_NPDU_BUFFER* help = NULL; T_SN_DATA_REQ* sn_data_req = NULL; TRACE_FUNCTION( "mg_clean_ack_npdu_queues_leave_data" ); /* * set service instance according to sapi */ sndcp_get_nsapi_sapi(nsapi, &used_sapi); sndcp_get_sapi_index(used_sapi, &sapi_index); sndcp_data->sua = & sndcp_data->sua_base[sapi_index]; if (sndcp_data->sua->sn_data_q_write != sndcp_data->sua->sn_data_q_read) { /* * remove unhandled sn_data_req from queue. */ sn_data_req = sndcp_data->sua->sn_data_q[sndcp_data->sua->sn_data_q_read]; FREE(sn_data_req); } /* * set service instance according to nsapi */ sndcp_data->nu = & sndcp_data->nu_base[nsapi]; /* * clean buffer with unconfirmed NPDUs */ while(sndcp_data->nu->first_buffered_npdu != NULL) { help = sndcp_data->nu->first_buffered_npdu; sndcp_data->nu->first_buffered_npdu = help->next; MFREE(help->sn_data_req); MFREE(help); } } /* +------------------------------------------------------------------------------ | Function : mg_clean_unack_npdu_queues_including_data +------------------------------------------------------------------------------ | Description : This procedure deletes SNDCP's internal buffers containing | unacknowledged type NPDU's. | The data stored in the queues are also deleted. | | Parameters : nsapi | +------------------------------------------------------------------------------ */ GLOBAL void mg_clean_unack_npdu_queues_including_data(U8 nsapi) { /* * Delete affected N-PDUS from sn_unitdata_q. */ BOOL still = TRUE; U8 index = sndcp_data->su->sn_unitdata_q_read; while (still) { if (index == sndcp_data->su->sn_unitdata_q_write) { break; } if (sndcp_data->su->sn_unitdata_q[index]->nsapi == nsapi) { /* * The index for the prims to be shifted when 1 entry is deleted. */ U8 i = 0; if (sndcp_data->su->sn_unitdata_q[index] != NULL) { PFREE_DESC2(sndcp_data->su->sn_unitdata_q[index]); sndcp_data->su->sn_unitdata_q[index] = NULL; } for (i = index; i != sndcp_data->su->sn_unitdata_q_write; i = (i + 1) % SN_UNITDATA_Q_LEN) { sndcp_data->su->sn_unitdata_q[i] = sndcp_data->su->sn_unitdata_q[(i + 1) % SN_UNITDATA_Q_LEN]; sndcp_data->su->sn_unitdata_q[(i + 1) % SN_UNITDATA_Q_LEN]=NULL; } sndcp_data->su->sn_unitdata_q_write = (sndcp_data->su->sn_unitdata_q_write - 1 + SN_UNITDATA_Q_LEN) % SN_UNITDATA_Q_LEN; } else { index = (index + 1) % SN_UNITDATA_Q_LEN; } /* else (sndcp_data->su->sn_unitdata_q[index]->nsapi == nsapi) */ } } /* +------------------------------------------------------------------------------ | Function : sm_make_test_pending_pdu_cnf +------------------------------------------------------------------------------ | Description : Initialize SN_TEST_GET_PENDING_PDU_CNF primitive | Parameters : sn_get_pending_pdu_cnf - primitive | sn_test_get_pending_pdu_cnf - primitive | +------------------------------------------------------------------------------ */ GLOBAL void sm_make_test_pending_pdu_cnf (T_SN_GET_PENDING_PDU_CNF* sn_get_pending_pdu_cnf, T_SN_TEST_GET_PENDING_PDU_CNF* sn_test_get_pending_pdu_cnf) { int i,j; for (i = 0; i < SN_SIZE_NSAPI; i++) { sn_test_get_pending_pdu_cnf->c_test_ul_pdus = sn_get_pending_pdu_cnf->c_ul_pdus; sn_test_get_pending_pdu_cnf->test_ul_pdus[i].nsapi = sn_get_pending_pdu_cnf->ul_pdus[i].nsapi; sn_test_get_pending_pdu_cnf->test_ul_pdus[i].test_dl_sequence_number = sn_get_pending_pdu_cnf->ul_pdus[i].dl_sequence_number; sn_test_get_pending_pdu_cnf->test_ul_pdus[i].c_test_desc_list2 = sn_get_pending_pdu_cnf->ul_pdus[i].c_desc_list2; if (sn_get_pending_pdu_cnf->ul_pdus[i].c_desc_list2) { for(j = 0; j < sn_get_pending_pdu_cnf->ul_pdus[i].c_desc_list2; j++) { sn_test_get_pending_pdu_cnf->test_ul_pdus[i].c_test_desc_list2 = sn_get_pending_pdu_cnf->ul_pdus[i].c_desc_list2; sn_test_get_pending_pdu_cnf->test_ul_pdus[i].test_desc_list2[j].c_test_pending_pdu = (U8)sn_get_pending_pdu_cnf->ul_pdus[i].ptr_desc_list2[j].list_len; memcpy( sn_test_get_pending_pdu_cnf->test_ul_pdus[i].test_desc_list2[j].test_pending_pdu, ((T_desc2 *)sn_get_pending_pdu_cnf->ul_pdus[i].ptr_desc_list2[j].first)->buffer, sn_get_pending_pdu_cnf->ul_pdus[i].ptr_desc_list2[j].list_len); } } } } #endif /*#ifdef TI_DUAL_MODE*/