FreeCalypso > hg > freecalypso-sw
diff gsm-fw/g23m-gsm/dl/dl_com.c @ 673:2f7df7a314f8
gsm-fw/g23m-gsm subtree: initial import from LoCosto source
author | Michael Spacefalcon <msokolov@ivan.Harhan.ORG> |
---|---|
date | Sun, 28 Sep 2014 23:20:04 +0000 |
parents | |
children | 900be07de4e8 |
line wrap: on
line diff
--- /dev/null Thu Jan 01 00:00:00 1970 +0000 +++ b/gsm-fw/g23m-gsm/dl/dl_com.c Sun Sep 28 23:20:04 2014 +0000 @@ -0,0 +1,1327 @@ +/* ++----------------------------------------------------------------------------- +| Project : +| Modul : ++----------------------------------------------------------------------------- +| 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 defines the common functions +| for the component DL of the mobile station. ++----------------------------------------------------------------------------- +*/ + +#ifndef DL_COM_C +#define DL_COM_C + +#define ENTITY_DL + +/*==== INCLUDES ===================================================*/ +#include "typedefs.h" +#include <string.h> +#include "vsi.h" +#if !defined(DL_2TO1) +//#include "p_8010_147_l1_include.h" +#endif /* DL_2TO1 */ +#include "pconst.cdg" +#include "custom.h" +#include "gsm.h" +#include "mon_dl.h" +#include "prim.h" +#include "pei.h" +#include "tok.h" +#include "ccdapi.h" +#include "dl.h" +#include "dl_trc.h" +#include "dl_em.h" + +/*==== TEST TRACE ===================================================*/ +#define TEST_ENTITY_DL + +/*==== EXPORT =====================================================*/ + +/*==== PRIVAT =====================================================*/ +LOCAL void com_build_frame ( + UBYTE ch_type, + UBYTE type, + UBYTE sapi, + UBYTE cr, + UBYTE ns, + UBYTE nr, + UBYTE p_bit, + UBYTE length, + UBYTE m_bit, + UBYTE * pInfoBuffer, + UBYTE InfoOffset); + +/*==== VARIABLES ==================================================*/ + +/*==== FUNCTIONS ==================================================*/ + +/* ++------------------------------------------------------------------------------ +| Function : com_free_pointer ++------------------------------------------------------------------------------ +| Description : frees the pointer given by parameter ++------------------------------------------------------------------------------ +*/ +GLOBAL void com_free_pointer (void * pointer) +{ + GET_INSTANCE_DATA; + TRACE_EVENT_WIN_P1 ("com_free_pointer(,p=%08x)", pointer); + +#if defined(INVOKE_SIGNAL) + if (dl_data->interrupt_context) + { + sig_invoke_com_free_pointer (pointer); + return; + } +#endif /* INVOKE_SIGNAL */ + +TRACE_ASSERT(pointer); + MY_PFREE (pointer); +} + +GLOBAL void com_free_queue_buffer (T_QUEUE * queue, USHORT index) +{ + T_DL_DATA_REQ **pp; + + switch (index) + { + default: + if (index <= INDEX_MAX_STORE_BUFFER) + pp = &queue->store_buffer[index]; + else + pp = NULL; + break; + case INDEX_SENDING_BUFFER: + pp = &queue->sending_buffer; + break; + case INDEX_SWITCH_BUFFER: + pp = &queue->switch_buffer; + break; + } + if (pp AND *pp) + { + COM_FREE_POINTER (*pp); + *pp = NULL; + } +} + +/* ++--------------------------------------------------------------------+ +| PROJECT : GSM-PS (6147) MODULE : DL_COM | +| STATE : code ROUTINE : com_clear_queue | ++--------------------------------------------------------------------+ + + PURPOSE : Clearing a DL queue. + +*/ + +GLOBAL void com_clear_queue (UBYTE sapi) +{ + GET_INSTANCE_DATA; + USHORT i; + T_QUEUE *queue; + TRACE_FUNCTION ("com_clear_queue()"); + + if (sapi EQ PS_SAPI_0) + { + queue = &dl_data->dcch0_queue; + } + else + { + queue = &dl_data->dcch3_queue; + } + + for (i=0;i<MAX_QUEUED_MESSAGES;i++) + if (queue->store_buffer [i] NEQ NULL) + { + COM_FREE_QUEUE_BUFFER (queue, i); + } + + if (queue->sending_buffer NEQ NULL) + { + COM_FREE_QUEUE_BUFFER (queue, INDEX_SENDING_BUFFER); + } + + if (queue->switch_buffer NEQ NULL) + { + COM_FREE_QUEUE_BUFFER (queue, INDEX_SWITCH_BUFFER); + } + queue->act_length = queue->act_offset = 0; + queue->no_of_stored_messages = 0; + memset (&queue->transmit_buffer, 0, sizeof (T_FRAME)); +} + +/* ++--------------------------------------------------------------------+ +| PROJECT : GSM-PS (6147) MODULE : DL_COM | +| STATE : code ROUTINE : com_restore_queue | ++--------------------------------------------------------------------+ + + PURPOSE : Restoring a DL queue. If a new connection shall be + established, the message (ASSIGNMENT or HANDOVER COMPLETE) + is transmitted first. So the message is stored in the + switch buffer. A previously not complete send message will + be put back into the storing buffer. + +*/ + +GLOBAL void com_restore_queue (UBYTE sapi, T_DL_DATA_REQ* est_req) +{ + GET_INSTANCE_DATA; + T_QUEUE *queue = sapi EQ PS_SAPI_0 ? &dl_data->dcch0_queue:&dl_data->dcch3_queue; + + TRACE_FUNCTION ("com_restore_queue()"); + + if (queue->switch_buffer NEQ NULL) + { + TRACE_EVENT_WIN ("free old switch_buffer"); + COM_FREE_QUEUE_BUFFER (queue, INDEX_SWITCH_BUFFER); + } + + if (est_req AND est_req->sdu.l_buf) + { + PPASS (est_req, data_req, DL_DATA_REQ); + queue->switch_buffer = data_req; /* only valid sdu */ + + TRACE_EVENT_WIN_P2 ("new fill of switch_buffer:%p l=%u", + data_req, est_req->sdu.l_buf>>3); + } + + if (queue->sending_buffer NEQ NULL) + { + TRACE_EVENT_WIN ("restore sending_buffer"); + queue->act_length = queue->sending_buffer->sdu.l_buf; + queue->act_offset = queue->sending_buffer->sdu.o_buf; + } + TRACE_EVENT_WIN ("delete transmit_buffer"); + memset (&queue->transmit_buffer, 0, sizeof (T_FRAME)); +} + +/* ++--------------------------------------------------------------------+ +| PROJECT : GSM-PS (6147) MODULE : DL_COM | +| STATE : code ROUTINE : com_recover_queue | ++--------------------------------------------------------------------+ + + PURPOSE : Recover a DL queue after a Reject condition. + +*/ + +GLOBAL void com_recover_queue (UBYTE sapi) +{ + GET_INSTANCE_DATA; + T_QUEUE *queue = sapi EQ PS_SAPI_0 ? &dl_data->dcch0_queue:&dl_data->dcch3_queue; + + TRACE_FUNCTION ("com_recover_queue()"); + + if (queue->sending_buffer NEQ NULL) + { + if(queue->act_length NEQ 0) /* For last buf, act_length is set to 0 */ + { /* and the act_offset is not modified */ + queue->act_offset -= queue->transmit_buffer.l_buf; + } + queue->act_length += queue->transmit_buffer.l_buf; + } + memset (&queue->transmit_buffer, 0, sizeof (T_FRAME)); +} + +/* ++--------------------------------------------------------------------+ +| PROJECT : GSM-PS (6147) MODULE : DL_COM | +| STATE : code ROUTINE : com_read_queue | ++--------------------------------------------------------------------+ + + PURPOSE : Reading the next segment of a message from a DL queue. + If a message in the switch buffer is stored, this message + is used. If a message is stored in the sending buffer which + is not send completely the next segment is copied to the + transmit buffer. Else the next sending buffer is copied from + the store buffer of the queue. The first segment of this + message is copied to the transfer buffer. + +*/ + +GLOBAL void com_read_queue (UBYTE ch_type, UBYTE sapi, + UBYTE * m_bit) +{ + GET_INSTANCE_DATA; + USHORT i; + USHORT length, bit_length; + T_DL_DATA_REQ * dl_data_req; + T_QUEUE *queue = sapi EQ PS_SAPI_0 ? &dl_data->dcch0_queue : &dl_data->dcch3_queue; + + TRACE_FUNCTION ("com_read_queue()"); + TRACE_EVENT_WIN_P1 ("read sapi_%u_queue", sapi); + + switch (ch_type) + { + case L2_CHANNEL_SDCCH: + length = N201_SDCCH; + break; + + case L2_CHANNEL_SACCH: + length = N201_SACCH; + break; + + case L2_CHANNEL_FACCH_F: + case L2_CHANNEL_FACCH_H: + length = N201_FACCH; + break; + + default: + length = 0; + bit_length = 0; + break; + } + bit_length = length << 3; + + if (queue->switch_buffer NEQ NULL) + { + T_DL_DATA_REQ *switch_buffer = queue->switch_buffer; + + TRACE_EVENT_WIN_P2 ("fill transmit_buffer with bytes %u-%u of switch_buffer, no bytes left", + (switch_buffer->sdu.o_buf>>3), + ((switch_buffer->sdu.o_buf+switch_buffer->sdu.l_buf)>>3)-1); + + queue->m_bit = * m_bit = 0; + queue->transmit_buffer.o_buf = 24; + queue->transmit_buffer.l_buf = switch_buffer->sdu.l_buf; + for (i=0;i<(switch_buffer->sdu.l_buf>>3);i++) + queue->transmit_buffer.buf[i+3] = + switch_buffer->sdu.buf[i+(switch_buffer->sdu.o_buf>>3)]; + + /* + should be freed first after acknowledgement! + COM_FREE_QUEUE_BUFFER (dl_data, queue, INDEX_SWITCH_BUFFER); + */ + return; + } + else + { + if (queue->act_length EQ 0) + { + if (queue->sending_buffer NEQ NULL) + { + COM_FREE_QUEUE_BUFFER (queue, INDEX_SENDING_BUFFER); + } + queue->sending_buffer = queue->store_buffer[0]; + queue->act_offset = queue->sending_buffer->sdu.o_buf; + queue->act_length = queue->sending_buffer->sdu.l_buf; + TRACE_EVENT_WIN_P2 ("fill sending_buffer with bytes %u-%u of store_buffer[0]", + (queue->sending_buffer->sdu.o_buf>>3), + ((queue->sending_buffer->sdu.o_buf+queue->sending_buffer->sdu.l_buf)>>3)-1); + + for (i=0;i<MAX_QUEUED_MESSAGES-1;i++) + queue->store_buffer[i] = queue->store_buffer[i+1]; + queue->no_of_stored_messages--; + + TRACE_EVENT_WIN_P1 ("left no_of_stored_messages=%u", queue->no_of_stored_messages); + } + dl_data_req = queue->sending_buffer; + } + + + if (queue->act_length > bit_length) + { /* + * lint Info 702: Shift right of signed quantity: + * not possible because of the compare one line before + */ + TRACE_EVENT_WIN_P3 ("fill transmit_buffer with bytes %u-%u of sending_buffer, %u bytes left", + queue->act_offset>>3, (queue->act_offset>>3)+length-1, + (queue->act_length-bit_length)>>3); + + queue->m_bit = * m_bit = 1; + queue->transmit_buffer.o_buf = 24; + queue->transmit_buffer.l_buf = bit_length; + for (i=0;i<length;i++) + queue->transmit_buffer.buf[i+3] = + dl_data_req->sdu.buf[i+(queue->act_offset>>3)]; + queue->act_offset += bit_length; + queue->act_length -= bit_length; + } + else + { + TRACE_EVENT_WIN_P2 ("fill transmit_buffer with bytes %u-%u of sending_buffer, no bytes left", + queue->act_offset>>3, ((queue->act_offset+queue->act_length)>>3)-1); + + queue->m_bit = * m_bit = 0; + queue->transmit_buffer.o_buf = 24; + queue->transmit_buffer.l_buf = queue->act_length; + for (i=0;i<(queue->act_length>>3);i++) + queue->transmit_buffer.buf[i+3] = + dl_data_req->sdu.buf[i+(queue->act_offset>>3)]; + queue->act_length = 0; + } +} + +/* ++--------------------------------------------------------------------+ +| PROJECT : GSM-PS (6147) MODULE : DL_COM | +| STATE : code ROUTINE : com_store_queue | ++--------------------------------------------------------------------+ + + PURPOSE : Storing a message into the queue. + +*/ + +GLOBAL void com_store_queue (UBYTE sapi, T_DL_DATA_REQ * data_req) +{ + GET_INSTANCE_DATA; + T_QUEUE * queue; + + TRACE_FUNCTION ("com_store_queue()"); + + if (sapi EQ PS_SAPI_0) + { + queue = &dl_data->dcch0_queue; + } + else + { + queue = &dl_data->dcch3_queue; + } + + if (queue->no_of_stored_messages < MAX_QUEUED_MESSAGES) + { + queue->store_buffer[queue->no_of_stored_messages++] = data_req; + TRACE_EVENT_WIN_P3 ("sapi_%u_queue: add entry with %u bytes, no_of_stored_messages=%u", + sapi, data_req->sdu.l_buf>>3, queue->no_of_stored_messages); + } + else + { + COM_FREE_POINTER (data_req); + TRACE_EVENT_WIN_P1 ("sapi_%u_queue overflowed", sapi); + } +} + +/* ++------------------------------------------------------------------------------+ +| PROJECT : GSM-PS (6147) MODULE : DL_COM | +| STATE : code ROUTINE : com_queue_awaiting_transmission | ++------------------------------------------------------------------------------+ + + PURPOSE : The function checks whether any segment has to sended. + Function returns TRUE if a frame/segment is awaiting transmission. + Function returns FALSE if not. + +*/ + +GLOBAL BOOL com_queue_awaiting_transmission (UBYTE sapi) +{ + GET_INSTANCE_DATA; + T_QUEUE * queue; + BOOL ret; + + TRACE_EVENT_WIN_P1 ("com_queue_awaiting_transmission(SAPI=%u)", sapi); + + queue = (sapi EQ PS_SAPI_0) ? &dl_data->dcch0_queue : &dl_data->dcch3_queue; + if (sapi EQ PS_SAPI_0) + { + queue = &dl_data->dcch0_queue; + } + else + { + queue = &dl_data->dcch3_queue; + } + if (queue->switch_buffer NEQ NULL) + { + TRACE_EVENT_WIN_P1 ("sapi_%u_queue: switch_buffer is awaiting", sapi); + ret = TRUE; + } + else + { + if (queue->act_length EQ 0) + { + ret = queue->no_of_stored_messages NEQ 0; + if (ret) + { + TRACE_EVENT_WIN_P2 ("sapi_%u_queue: store_buffer is awaiting (no_of_stored_messages=%u)", + sapi, queue->no_of_stored_messages); + } + } + else + { + TRACE_EVENT_WIN_P2 ("sapi_%u_queue: transmit_buffer is awaiting (%u bytes)", + sapi, queue->act_length); + ret = TRUE; + } + } + + return ret; +} + +/* ++--------------------------------------------------------------------+ +| PROJECT : GSM-PS (6147) MODULE : DL_COM | +| STATE : code ROUTINE : com_leave_dedicated | ++--------------------------------------------------------------------+ + + PURPOSE : Leave dedicated mode. + +*/ + +GLOBAL void com_leave_dedicated (UBYTE ch_type) +{ + GET_INSTANCE_DATA; + dl_data->RR_dedicated = FALSE; /* RR is leaving the dedicated mode */ + DL_OFFLINE_TRACE (TRACE_DL_EVENT, TRACE_CH_UNKNOWN, ch_type, "RR_dedicated:=FALSE"); +} + +/* ++-----------------------------------------------------------------------------+ +| PROJECT : GSM-PS (6147) MODULE : DL_COM | +| STATE : code ROUTINE : possible_reset_dcch0_ch_type | ++-----------------------------------------------------------------------------+ + + PURPOSE : Reset dedicated channel. + +*/ +GLOBAL void possible_reset_dcch0_ch_type (void) +{ + GET_INSTANCE_DATA; + if ( + #if defined(DELAYED_SABM) + (dl_data->dcch0_sabm_flag NEQ NOT_PRESENT_8BIT) AND + #endif /* DELAYED_SABM */ + #if defined(DELAYED_RELEASE_IND) + (dl_data->release_ind_ch_type NEQ NOT_PRESENT_8BIT) AND + #endif /* DELAYED_RELEASE_IND */ + (dl_data->state[C_DCCH0] <= STATE_IDLE_DL) AND + (dl_data->cch[C_DCCH0].vtx EQ EMPTY_CMD)) + { + TRACE_EVENT_WIN_P1 ("reset dcch0_ch_type=%s ->0", CH_TYPE_NAME[dl_data->dcch0_ch_type]); + dl_data->dcch0_ch_type = 0; + } +} + +/* ++--------------------------------------------------------------------+ +| PROJECT : GSM-PS (6147) MODULE : DL_COM | +| STATE : code ROUTINE : com_compare_L3_msg | ++--------------------------------------------------------------------+ + + PURPOSE : The function compares two layer 3 messages. + + +*/ + +GLOBAL UBYTE com_compare_L3_msg (T_DL_DATA_REQ * data_ind1, UBYTE * data_ind2) +{ + USHORT length1; + USHORT length2; + USHORT pos1; + USHORT pos2; + USHORT i; + + TRACE_FUNCTION ("com_compare_L3_msg()"); + + /* + * Calculates Length of SABM and UA layer 3 message + */ + length1 = data_ind1->sdu.l_buf>>3; /* length of l3 msg inside SABM frame */ + length2 = ((data_ind2[2] & 0xFC)>>2); /* length of l3 msg inside UA frame */ + + if (length1 NEQ length2) + return FALSE; + + pos1 = data_ind1->sdu.o_buf >> 3; + pos2 = 3; + + + for (i=0; i<length1; i++) + { + if (data_ind1->sdu.buf[i+pos1] NEQ data_ind2[i+pos2]) + { +#if defined(DL_TRACE_ENABLED) + UBYTE sapi = data_ind1->sapi; + UBYTE trace_channel = TRACE_CH_UNKNOWN; + switch (data_ind1->ch_type) + { + case L2_CHANNEL_SDCCH: + if (sapi EQ PS_SAPI_0) + trace_channel = C_DCCH0; + else if (sapi EQ PS_SAPI_3) + trace_channel = C_DCCH3; + break; + case L2_CHANNEL_FACCH_F: + case L2_CHANNEL_FACCH_H: + trace_channel = C_DCCH0; + break; + default: + break; + }/* endswitch chan */ + DL_OFFLINE_TRACE(TRACE_DL_EVENT, trace_channel, data_ind1->ch_type, "UA doesn´t match"); +#endif /* DL_TRACE_ENABLED */ + return FALSE; + } + } + return TRUE; +} + +/* ++--------------------------------------------------------------------+ +| PROJECT : GSM-PS (6147) MODULE : DL_COM | +| STATE : code ROUTINE : com_concatenate | ++--------------------------------------------------------------------+ + + PURPOSE : Concenate an imcoming segment. + +*/ + +GLOBAL void com_concatenate (T_DL_DATA_IND ** in_msg, + UBYTE * new_data_in) +{ + GET_INSTANCE_DATA; + USHORT end_pos; + USHORT length; + USHORT start_pos; + #define L2_HEADER_BYTESIZE 3 + + TRACE_FUNCTION ("com_concatenate()"); + +#if defined(INVOKE_SIGNAL) + if (dl_data->interrupt_context) + { + sig_invoke_com_concatenate (in_msg, new_data_in); + return; + } +#endif /* INVOKE_SIGNAL */ + + length = new_data_in[2] >> 2; + + if (*in_msg EQ NULL) + { + /* + * Nothing stored yet + */ + USHORT len_in_bits = (length + L2_HEADER_BYTESIZE) << 3; + PALLOC_SDU (first_data, DL_DATA_IND, len_in_bits ); + + first_data->sdu.l_buf = length << 3; /* = length * BITS_PER_BYTE */ + first_data->sdu.o_buf = L2_HEADER_BYTESIZE << 3;/* = L2_HEADER_BYTESIZE * BITS_PER_BYTE */ + /*lint -e419 (Warning -- Apparent data overrun) */ + memset (&first_data->sdu.buf[0], 0, L2_HEADER_BYTESIZE); + /*lint +e419 (Warning -- Apparent data overrun) */ + /*lint -e416 (Warning -- creation of out-of-bounds pointer) */ + memcpy (&first_data->sdu.buf[L2_HEADER_BYTESIZE], + &new_data_in[L2_HEADER_BYTESIZE], + length); + /*lint +e416 (Warning -- creation of out-of-bounds pointer) */ + *in_msg = first_data; + } + else + { + T_DL_DATA_IND *previous_data = *in_msg; + + start_pos = previous_data->sdu.l_buf + previous_data->sdu.o_buf; + end_pos = (length << 3) + start_pos; + { + PALLOC_SDU (entire_data, DL_DATA_IND, end_pos ); + + /*lint -e415 (Warning -- access of out-of-bounds pointer) */ + memcpy (entire_data->sdu.buf, previous_data->sdu.buf, start_pos >> 3); + memcpy (&entire_data->sdu.buf[start_pos >> 3], + &new_data_in[L2_HEADER_BYTESIZE], + length); + /*lint +e415 (Warning -- access of out-of-bounds pointer) */ + + entire_data->sdu.l_buf = previous_data->sdu.l_buf + (length << 3); + entire_data->sdu.o_buf = previous_data->sdu.o_buf; + + COM_FREE_POINTER (*in_msg); + *in_msg = entire_data; + } + } +} + +/* ++--------------------------------------------------------------------+ +| PROJECT : GSM-PS (6147) MODULE : DL_COM | +| STATE : code ROUTINE : com_check_nr | ++--------------------------------------------------------------------+ + + PURPOSE : Check the receive number. + +*/ + +GLOBAL UBYTE com_check_nr (UBYTE va, UBYTE vs, UBYTE nr) +{ + BYTE a,b; + + TRACE_FUNCTION ("com_check_nr()"); + /* + * under GSM 4.06 subclause 3.5.2.3: + * nr is valid, if and only if ((nr-va) mod 8) <= ((vs-va) mod 8) + */ + a = (nr+8-va) & 7; + b = (vs+8-va) & 7; + + return (a <= b); +} + +/* ++--------------------------------------------------------------------+ +| PROJECT : GSM-PS (6147) MODULE : DL_COM | +| STATE : code ROUTINE : com_prepare_DISC | ++--------------------------------------------------------------------+ + + PURPOSE : Prepares a DISC command. + +*/ + +GLOBAL void com_prepare_DISC (UBYTE channel, UBYTE sapi) +{ + GET_INSTANCE_DATA; + T_CCH *pcch = &dl_data->cch[channel]; + + pcch->vtx = DISC_CMD; + pcch->time_flag = TRUE; + pcch->T200_counter = 0; + pcch->rc = 0; + set_channel_state (channel, STATE_AWAITING_RELEASE); + TRACE_EVENT_WIN_P3 ("RELEASE_REQ: %s SAPI=%u vtx=%s", CH_TYPE_NAME[pcch->ch_type], + sapi, VTX_NAME[pcch->vtx]); +} + +/* ++--------------------------------------------------------------------+ +| PROJECT : GSM-PS (6147) MODULE : DL_COM | +| STATE : code ROUTINE : com_build_UA_response | ++--------------------------------------------------------------------+ + + PURPOSE : Build an UA response. + +*/ + +GLOBAL void com_build_UA_response (UBYTE ch_type, UBYTE sapi, UBYTE f_bit) +{ + TRACE_FUNCTION ("com_build_UA_response()"); + com_build_frame (ch_type, UA_FRAME, sapi, MS2BS_RSP, 0, 0, f_bit, 0, 0, NULL, 0); +} + +/* ++--------------------------------------------------------------------+ +| PROJECT : GSM-PS (6147) MODULE : DL_COM | +| STATE : code ROUTINE : com_build_RR_response | ++--------------------------------------------------------------------+ + + PURPOSE : Build an RR response. + +*/ + +GLOBAL void com_build_RR_response (UBYTE ch_type, + UBYTE sapi, UBYTE nr, UBYTE f_bit) +{ + TRACE_FUNCTION ("com_build_RR_response()"); + com_build_frame (ch_type, RR_FRAME, sapi, MS2BS_RSP, 0, nr, f_bit, 0, 0, NULL, 0); +} + +#if 0 +/* ++--------------------------------------------------------------------+ +| PROJECT : GSM-PS (6147) MODULE : DL_COM | +| STATE : code ROUTINE : com_build_RR_command | ++--------------------------------------------------------------------+ + + PURPOSE : Build an RR command. + +*/ + +GLOBAL void com_build_RR_command (T_DL_DATA_STORE * dl_data, UBYTE ch_type, + UBYTE sapi, UBYTE nr, UBYTE p_bit) +{ + TRACE_FUNCTION ("com_build_RR_command()"); + com_build_frame (dl_data, ch_type, RR_FRAME, sapi, MS2BS_CMD, 0, nr, p_bit, 0, 0, NULL, 0); +} +#endif /* 0 */ +/* ++--------------------------------------------------------------------+ +| PROJECT : GSM-PS (6147) MODULE : DL_COM | +| STATE : code ROUTINE : com_build_REJ_response| ++--------------------------------------------------------------------+ + + PURPOSE : Build an REJ response. + +*/ + +GLOBAL void com_build_REJ_response (UBYTE ch_type, + UBYTE sapi, UBYTE nr, UBYTE f_bit) +{ + TRACE_FUNCTION ("com_build_REJ_response()"); + com_build_frame (ch_type, REJ_FRAME, sapi, MS2BS_RSP, 0, nr, f_bit, 0, 0, NULL, 0); +} + +/* ++--------------------------------------------------------------------+ +| PROJECT : GSM-PS (6147) MODULE : DL_COM | +| STATE : code ROUTINE : com_build_DISC_command | ++--------------------------------------------------------------------+ + + PURPOSE : Build a DISC command. + +*/ + +GLOBAL void com_build_DISC_command (UBYTE ch_type, + UBYTE sapi, UBYTE p_bit) +{ + TRACE_FUNCTION ("com_build_DISC_command()"); + com_build_frame (ch_type, DISC_FRAME, sapi, MS2BS_CMD, 0, 0, p_bit, 0, 0, NULL, 0); +} + +/* ++--------------------------------------------------------------------+ +| PROJECT : GSM-PS (6147) MODULE : DL_COM | +| STATE : code ROUTINE : com_build_SABM | ++--------------------------------------------------------------------+ + + PURPOSE : Build a SABM command with or without Layer 3 message. + +*/ + +GLOBAL void com_build_SABM (UBYTE ch_type, + UBYTE sapi, BOOL contention_resultion) +{ + GET_INSTANCE_DATA; + T_QUEUE *queue = &dl_data->dcch0_queue; + TRACE_FUNCTION ("com_build_SABM()"); + TRACE_EVENT_WIN_P3 ("com_build_SABM %s SAPI=%u %s", CH_TYPE_NAME[ch_type], sapi, + (contention_resultion AND queue->switch_buffer) ? "+L3" : ""); + + if (contention_resultion AND queue->switch_buffer) + { + com_build_frame (ch_type, SABM_FRAME, sapi, MS2BS_CMD, 0, 0, 1, + (UBYTE)(queue->switch_buffer->sdu.l_buf >> 3), 0, + queue->switch_buffer->sdu.buf, (UBYTE)(queue->switch_buffer->sdu.o_buf >> 3)); + } + else + { + com_build_frame (ch_type, SABM_FRAME, sapi, MS2BS_CMD, 0, 0, 1, 0, 0, NULL, 0); + } +} + +/* ++--------------------------------------------------------------------+ +| PROJECT : GSM-PS (6147) MODULE : DL_COM | +| STATE : code ROUTINE : com_build_DM_response | ++--------------------------------------------------------------------+ + + PURPOSE : Build an DM response. + +*/ + +GLOBAL void com_build_DM_response (UBYTE ch_type, + UBYTE sapi, UBYTE f_bit) +{ + TRACE_FUNCTION ("com_build_DM_response()"); + com_build_frame (ch_type, DM_FRAME, sapi, MS2BS_RSP, 0, 0, f_bit, 0, 0, NULL, 0); +} + + +/* ++--------------------------------------------------------------------+ +| PROJECT : GSM-PS (6147) MODULE : DL_COM | +| STATE : code ROUTINE : com_build_I_command | ++--------------------------------------------------------------------+ + + PURPOSE : Build an I command. + +*/ + +GLOBAL void com_build_I_command (UBYTE ch_type, + UBYTE sapi, UBYTE ns, UBYTE nr, UBYTE p_bit,UBYTE m_bit, T_QUEUE * queue) +{ + TRACE_FUNCTION ("com_build_I_command()"); + com_build_frame (ch_type, I_FRAME, sapi, MS2BS_CMD, ns, nr, p_bit, + (UBYTE)(queue->transmit_buffer.l_buf >> 3), m_bit, + queue->transmit_buffer.buf, 0); +} + +/* ++--------------------------------------------------------------------+ +| PROJECT : GSM-PS (6147) MODULE : DL_COM | +| STATE : code ROUTINE : com_build_UI_command | ++--------------------------------------------------------------------+ + + PURPOSE : Build an UI command. + +*/ + +GLOBAL void com_build_UI_command (UBYTE ch_type, + UBYTE sapi, const T_FRAME * buffer) +{ + TRACE_FUNCTION ("com_build_UI_command()"); + com_build_frame (ch_type, UI_FRAME, sapi, MS2BS_CMD, 0, 0, 0, + (UBYTE)(buffer->l_buf >> 3), 0, (UBYTE*)buffer->buf, (UBYTE)(buffer->o_buf >> 3)); +} + +/* ++--------------------------------------------------------------------+ +| PROJECT : GSM-PS (6147) MODULE : DL_COM | +| STATE : code ROUTINE : com_build_UI_Bter | ++--------------------------------------------------------------------+ + + PURPOSE : Build an UI frame in Bter format. + +*/ + +GLOBAL void com_build_UI_Bter (UBYTE ch_type) +{ + GET_INSTANCE_DATA; + unsigned off = dl_data->rr_short_pd_buffer.o_buf>>3; + unsigned len = dl_data->rr_short_pd_buffer.l_buf>>3; + unsigned foff, maxlen; + + if (ch_type EQ L2_CHANNEL_SACCH) + { + maxlen = DL_N201_SACCH_Bter; + foff = 2; +#ifndef DL_2TO1 + dl_data->l2_frame.A[0] = dl_data->l2_frame.A[1] = 0; /* place holder for L1 header */ +#else + dl_data->l2_frame.frame_array[0] = dl_data->l2_frame.frame_array[1] = 0; /* place holder for L1 header */ +#endif + + } + else + { + foff = 0; + maxlen = DL_N201_DCCH_Bter; + } + + if (len > maxlen) + len = maxlen; + /* + * LINT Warning 662: Possible creation of out-of-bounds pointer ... and + * LINT Warning 669: Possible data overrun for function 'memset ... + * can be ignored, because of the right alignment between foff and maxlen. + */ + /*lint -e662 -e669 Possible creation of out-of-bounds pointer or Possible data overrun*/ +#ifndef DL_2TO1 + memcpy (&dl_data->l2_frame.A[foff], dl_data->rr_short_pd_buffer.buf+off, len); + memset (&dl_data->l2_frame.A[foff+len], 0x2b, maxlen-len); +#else + memcpy (&dl_data->l2_frame.frame_array[foff], dl_data->rr_short_pd_buffer.buf+off, len); + memset (&dl_data->l2_frame.frame_array[foff+len], 0x2b, maxlen-len); +#endif +/* lint +e662 +e669 Possible creation of out-of-bounds pointer or Possible data overrun */ +/* mark message as handled */ + dl_data->rr_short_pd_buffer.l_buf = 0; +} + +/* ++--------------------------------------------------------------------+ +| PROJECT : GSM-PS (6147) MODULE : DL_COM | +| STATE : code ROUTINE : com_build_frame | ++--------------------------------------------------------------------+ + + PURPOSE : Builds any frame. + +*/ +LOCAL void com_build_frame (UBYTE ch_type, + UBYTE type, UBYTE sapi, UBYTE cr, UBYTE ns, + UBYTE nr, UBYTE p_bit, UBYTE length, UBYTE m_bit, + UBYTE* pInfoBuffer, UBYTE InfoOffset) +{ + GET_INSTANCE_DATA; + UBYTE offset; + UBYTE maxlength; +#ifndef DL_2TO1 + UBYTE *pOutFrame = dl_data->l2_frame.A; +#else + UBYTE *pOutFrame = dl_data->l2_frame.frame_array; +#endif /* DL_2TO1*/ +#define SPARE 0 +#define LPD 0 +#define EA 1 +#define EL 1 + + if (ch_type EQ L2_CHANNEL_SACCH) + { + offset = 2; + maxlength = DL_N201_SACCH_A_B; + pOutFrame[0] = pOutFrame[1] = 0; /* reset layer 1 header */ + } + else + { + offset = 0; + maxlength = DL_N201_DCCH_A_B; + } + + if (length > maxlength) + { + TRACE_EVENT_P1 ("Error: framelength to big %d", length); + length = maxlength; /* for safety's sake */ + } + + /* + * set header bytes (bit 8 7 6 5 4 3 2 1) + * address field | | | | | | | + * Spare --LPD- ----SAPI--- C/R EA + */ + pOutFrame[offset] = (SPARE << 7) | (LPD << 5) | (sapi << 2) | (cr << 1) | EA; + + /* + * control field 8 7 6 5 4 3 2 1 + * I format ----N(R)--- P ----N(S)--- 0 + * S format ----N(R)--- P/F S S 0 1 + * U format U U U P/F U U 1 1 + */ + if ((type & 0x01) EQ 0) + pOutFrame[offset+1] = (nr << 5) | (p_bit << 4) | (ns << 1); /* I format */ + else if ((type & 0x02) EQ 0) + pOutFrame[offset+1] = (nr << 5) | (p_bit << 4) | type; /* S format */ + else + pOutFrame[offset+1] = (p_bit << 4) | type; /* U format */ + + /* + * length field 8 3 2 1 + * -----length indicator----- M EL + */ + pOutFrame[offset+2] = (length << 2) | (m_bit << 1) | EL; + + /* + * LINT Warning 662: Possible creation of out-of-bounds pointer ... and + * LINT Warning 669: Possible data overrun for function 'memcpy ... and + * LINT Warning 671: Possibly passing to function 'memset ... + * can be ignored because the sum of offset, 3 plus maxlength (length) does + * never exceed the maximal size of pOutFrame[]. + */ + if (length && pInfoBuffer) + {/* copy info bits */ + memcpy (&pOutFrame[offset+3], pInfoBuffer + (InfoOffset ? InfoOffset : 3), length); + offset += length; + maxlength -= length; + } + + /* fill remain of the frame with 0x2b */ + memset (&pOutFrame[offset+3], 0x2b, maxlength); + +#undef SPARE +#undef LPD +#undef EA +#undef EL +}/* endfunc com_build_frame */ + +/* ++--------------------------------------------------------------------+ +| PROJECT : GSM-PS (6147) MODULE : DL_COM | +| STATE : code ROUTINE : com_data_ind | ++--------------------------------------------------------------------+ + + PURPOSE : Indicates a downlinked message to RR. The queue which is + taken depend on the sapi value. In case of sapi=0 the function + checks the layer 3 message for a channel release additionally. + This is done to speed up the release procedure. + +*/ +GLOBAL void com_data_ind (UBYTE ch_type, UBYTE sapi, ULONG fn) +{ + GET_INSTANCE_DATA; + T_DL_DATA_IND *in_msg; + +#if defined(INVOKE_SIGNAL) + if (dl_data->interrupt_context) + { + sig_invoke_com_data_ind (ch_type, sapi, fn); + return; + } +#endif /* INVOKE_SIGNAL */ + + if (sapi EQ PS_SAPI_0) + { + in_msg = dl_data->dcch0_in_msg; + + if (in_msg) + { /* + * Purpose: Check if message is channel release, then start release + * of connection. This will be done to speed up the DISC process. + */ + /*lint -e415 (Warning -- access of out-of-bounds pointer) */ + /*lint -e416 (Warning -- creation of out-of-bounds pointer) */ + if ((in_msg->sdu.buf[3] EQ 0x06) AND /* PD RR */ + (in_msg->sdu.buf[4] EQ 0x0D)) /* MT channel release */ + { + /*lint +e416 (Warning -- creation of out-of-bounds pointer) */ + /*lint +e415 (Warning -- access of out-of-bounds pointer) */ + /* + * Send immediately (on the next uplink opportunity) a DISC frame + * on DCCH. + * Disable dedicated mode -> restrain measurement reports + */ + dl_data->dcch0_disc_request = TRUE; + DL_OFFLINE_TRACE(TRACE_DL_EVENT, C_DCCH0, ch_type, "CHANNEL REL received"); +#if !defined(LATE_LEAVING_DEDICATED) + com_leave_dedicated (ch_type); +#endif /* LATE_LEAVING_DEDICATED */ + } + } + } + else + { + in_msg = dl_data->dcch3_in_msg; + } + + if (in_msg) + { + in_msg->ch_type = ch_type; + in_msg->sapi = sapi; + drr_dl_data_ind (sapi, fn); + } + else + { + DL_OFFLINE_TRACE (TRACE_DL_EVENT, + (sapi EQ PS_SAPI_0) ? C_DCCH0 : C_DCCH3, ch_type, "dcchx_in_msg=NULL"); + } +} + +#if !defined(NTRACE) +#if defined(DL_TRACE_ENABLED) && defined(DL_IMMEDIATE_TRACE) +/* ++--------------------------------------------------------------------+ +| PROJECT : GSM-PS (6147) MODULE : DL_COM | +| STATE : code ROUTINE : com_l2trace | ++--------------------------------------------------------------------+ + + PURPOSE : Send L2 trace. + +*/ + +GLOBAL void com_l2trace (UBYTE trace_type, + UBYTE channel, UBYTE ch_type, T_TIME trace_time, UBYTE* data) +{ + GET_INSTANCE_DATA; + ULONG trace_mask; + +#ifdef TI_PS_HCOMM_CHANGE + vsi_gettracemask(_hCommDL, _hCommDL, &trace_mask); +#else + vsi_gettracemask(hCommDL, hCommDL, &trace_mask); +#endif + if ((trace_mask & TC_USER1) EQ 0) + return; + + if (trace_time EQ 0) + vsi_t_time (VSI_CALLER &trace_time); + +#if defined(INVOKE_SIGNAL) + if (dl_data->interrupt_context) + { + sig_invoke_com_l2trace (trace_type, channel, ch_type, trace_time, data); + return; + } +#endif /* INVOKE_SIGNAL */ + dl_fast_trace(trace_type, channel, ch_type, trace_time, trace_mask, data); +} +#endif /* DL_TRACE_ENABLED && DL_IMMEDIATE_TRACE */ + +/* ++--------------------------------------------------------------------+ +| PROJECT : GSM-PS (6147) MODULE : DL_COM | +| STATE : code ROUTINE : com_l3trace | ++--------------------------------------------------------------------+ + + PURPOSE : Send L3 trace. + +*/ + +GLOBAL void com_l3trace (UBYTE type, UBYTE ch_type, UBYTE *frame) +{ + GET_INSTANCE_DATA; + ULONG trace_mask; + +#ifdef TI_PS_HCOMM_CHANGE + vsi_gettracemask(_hCommDL, _hCommDL, &trace_mask); +#else + vsi_gettracemask(hCommDL, hCommDL, &trace_mask); +#endif + if ((trace_mask & TC_USER4) EQ 0) + return; + +#if defined(INVOKE_SIGNAL) + if (dl_data->interrupt_context) + { + sig_invoke_com_l3trace (type, ch_type, frame); + return; + } +#endif /* INVOKE_SIGNAL */ + + if (type EQ TRACE_UPLINK) + { /* uplink acknowledged */ + T_DL_DATA_REQ *d = (T_DL_DATA_REQ *)frame; + com_print_l3trace (TRACE_UPLINK, ch_type, d->sapi, (UBYTE *)&d->sdu); + } + else if (type EQ TRACE_DOWNLINK) + { /* downlink */ + T_DL_DATA_IND *d = (T_DL_DATA_IND *)frame; + com_print_l3trace (TRACE_DOWNLINK, ch_type, d->sapi, (UBYTE *)&d->sdu); + } + else if ((type EQ TRACE_UACK_UP) OR (type EQ TRACE_UACK_DN)) + { + com_print_l3trace (type, ch_type, PS_SAPI_0, frame); + } +} + +GLOBAL void com_print_l3trace (UBYTE type, UBYTE ch_type, UBYTE sapi, UBYTE *l3msg) +{ + char description[40]; + + switch (type) + { + case TRACE_UPLINK: + case TRACE_DOWNLINK: + { + T_sdu *sdu = (T_sdu *)l3msg; + sprintf (description, "L3 %s ch=%u SAPI%u", + type EQ TRACE_UPLINK ? "UP" : "DN", ch_type, sapi); +#ifdef TI_PS_HCOMM_CHANGE + TRACE_BINDUMP(_hCommDL, TC_USER4, description, + sdu->buf+(sdu->o_buf>>3), (sdu->l_buf>>3)); +#else + TRACE_BINDUMP(hCommDL, TC_USER4, description, + sdu->buf+(sdu->o_buf>>3), (sdu->l_buf>>3)); +#endif + } + break; + case TRACE_UACK_UP: + case TRACE_UACK_DN: + if (GET_BTER_FORMAT (&l3msg[0]) EQ SHORT_L2_HEADER_TYPE_1) + { + sprintf (description, "L3 %s ch=%u SAPI%u RR Short PD header", + type EQ TRACE_UACK_UP ? "UP" : "DN", ch_type, sapi); +#ifdef TI_PS_HCOMM_CHANGE + TRACE_BINDUMP(_hCommDL, TC_USER4, description, l3msg, DL_N201_SACCH_Bter); +#else + TRACE_BINDUMP(hCommDL, TC_USER4, description, l3msg, DL_N201_SACCH_Bter); +#endif + } + else + { + sprintf (description, "L3 %s ch=%u SAPI%u", + type EQ TRACE_UACK_UP ? "UP" : "DN", ch_type, sapi); +#ifdef TI_PS_HCOMM_CHANGE + TRACE_BINDUMP(_hCommDL, TC_USER4, description, l3msg, DL_N201_SACCH_A_B); +#else + TRACE_BINDUMP(hCommDL, TC_USER4, description, l3msg, DL_N201_SACCH_A_B); +#endif + } + break; + } +} +#endif /* !NTRACE */ + +/* ++--------------------------------------------------------------------+ +| PROJECT : GSM-PS (6147) MODULE : DL_COM | +| STATE : code ROUTINE : com_init_data | ++--------------------------------------------------------------------+ + + PURPOSE : Initializes the data for one instance. + +*/ + +GLOBAL void com_init_data (void) +{ + GET_INSTANCE_DATA; + TRACE_FUNCTION ("com_init_data()"); + + memset (dl_data, 0, sizeof (T_DL_DATA_STORE)); + + dl_data->cch[C_DCCH0].T200_counter = 0; + dl_data->cch[C_DCCH3].T200_counter = 0; + dl_data->cch[C_SACCH0].T200_counter = 0; + dl_data->dcch0_in_msg = NULL; + dl_data->dcch3_in_msg = NULL; + + dl_data->dcch0_disc_request = FALSE; + dl_data->dcch3_disc_request = FALSE; + dl_data->RR_dedicated = FALSE; + dl_data->fn = NOT_PRESENT_32BIT; + +#if defined(INVOKE_SIGNAL) + sig_init_signal_data (); +#endif /* INVOKE_SIGNAL */ +} + + +#if defined (DL_TRACE_ENABLED) || defined (FF_EM_MODE) +/* +* Some of the functions originally designed for DL tracing are used as well for +* the engineering mode and therefore defined here. +*/ + +GLOBAL void com_semaphore_err (void) +{ +#if defined(_SIMULATION_) + SYST_TRACE ("DL:error:semaphore"); + TRACE_ASSERT (1); +#else /* _SIMULATION_ */ +static UCHAR out = 0; + if (!out) + { + out = 1; + SYST_TRACE ("DL:error:semaphore"); + vsi_t_sleep(VSI_CALLER 10000); + TRACE_ASSERT (1); + } +#endif /* _SIMULATION_ */ +} + +GLOBAL int com_enter_critical_section (T_HANDLE sem) +{ + if (vsi_s_get (VSI_CALLER sem) NEQ VSI_OK) + { + com_semaphore_err(); + return -1; + } + else + { + return 0; + } +}/*endfunc com_enter_critical_section*/ + +GLOBAL int com_leave_critical_section (T_HANDLE sem) +{ + if (vsi_s_release (VSI_CALLER sem) NEQ VSI_OK) + { + com_semaphore_err(); + return -1; + } + else + { + return 0; + } +}/* endfunc com_leave_critical_section */ + +#if !defined(DL_IMMEDIATE_TRACE) +GLOBAL int com_semaphore_state (T_HANDLE sem) +{ + USHORT semCount; + + if (vsi_s_status (VSI_CALLER sem, &semCount) NEQ VSI_OK) + { + com_semaphore_err (); + return -1; + } + if (semCount EQ 0) + { + SYST_TRACE ("DL:semCount == 0"); + return 1; + } + else + return 0; +} +#endif /* !DL_IMMEDIATE_TRACE */ +#endif /* defined (DL_TRACE_ENABLED) || defined (FF_EM_MODE) */ + +#endif /* DL_COM_C */ +