FreeCalypso > hg > fc-selenite
view src/g23m-gprs/sndcp/sndcp_suap.c @ 65:3ba29033523a
src/cs/drivers/drv_app/ffs/board/core.h: slight reordering to pass gcc
author | Mychaela Falconia <falcon@freecalypso.org> |
---|---|
date | Fri, 20 Jul 2018 00:13:49 +0000 |
parents | d393cd9bb723 |
children |
line wrap: on
line source
/* +----------------------------------------------------------------------------- | Project : GPRS (8441) | Modul : sndcp_suap.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 | functions to handles the incoming primitives as described in | the SDL-documentation (SUA-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 "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_suaf.h" /* to get internal functions of service sua */ #include "sndcp_nus.h" /* to get signal functions to service nu */ /*==== CONST ================================================================*/ /*==== LOCAL VARS ===========================================================*/ /*==== PRIVATE FUNCTIONS ====================================================*/ /*==== PUBLIC FUNCTIONS =====================================================*/ /* +------------------------------------------------------------------------------ | Function : sua_ll_data_cnf +------------------------------------------------------------------------------ | Description : Handles the primitive LL_DATA_CNF | | Parameters : *ll_data_cnf - Ptr to primitive payload | +------------------------------------------------------------------------------ */ GLOBAL void sua_ll_data_cnf ( T_LL_DATA_CNF *ll_data_cnf ) { BOOL complete = FALSE; BOOL found = FALSE; T_SEG_INFO* help = NULL; T_SEG_INFO* last_help = NULL; UBYTE sapi_index = 0; UBYTE refi = 0; TRACE_FUNCTION( "sua_ll_data_cnf" ); /* * set service instance according to sapi in primitive */ sndcp_get_sapi_index(ll_data_cnf->sapi, &sapi_index); sndcp_data->sua = & sndcp_data->sua_base[sapi_index]; TRACE_EVENT_P1("ll_data_cnf->c_reference1: %d", ll_data_cnf->c_reference1); switch( GET_STATE( SUA ) ) { case SUA_LLC_NOT_RECEPTIVE_SUSPEND: case SUA_LLC_RECEPTIVE_SUSPEND: case SUA_LLC_NOT_RECEPTIVE: case SUA_LLC_RECEPTIVE: for (refi = 0; refi < ll_data_cnf->c_reference1; refi++) { complete = FALSE; found = FALSE; last_help = NULL; help = sndcp_data->sua->first_seg_info; if (help == NULL) { /* * There are no N-PDUs buffered. CNF must be wrong. */ if (ll_data_cnf != NULL) { TRACE_EVENT("There are no N-PDUs buffered. CNF must be wrong."); PFREE(ll_data_cnf); } return; } while (help != NULL && !found) { TRACE_EVENT_P1("ll_data_cnf->reference1[refi].ref_nsapi: %d", ll_data_cnf->reference1[refi].ref_nsapi); TRACE_EVENT_P1("ll_data_cnf->reference1[refi].ref_npdu_num: %d", ll_data_cnf->reference1[refi].ref_npdu_num); TRACE_EVENT_P1("ll_data_cnf->reference1[refi].ref_seg_num: %d", ll_data_cnf->reference1[refi].ref_seg_num); if (ll_data_cnf->reference1[refi].ref_nsapi == help->nsapi && ll_data_cnf->reference1[refi].ref_npdu_num == help->npdu_number) { TRACE_EVENT_P1("ll_data_cnf->reference1[refi].ref_seg_num: %d", ll_data_cnf->reference1[refi].ref_seg_num); TRACE_EVENT_P1("old help->cnf_segments: %d", help->cnf_segments); help->cnf_segments += 1 << ll_data_cnf->reference1[refi].ref_seg_num; TRACE_EVENT_P1("new help->cnf_segments: %d", help->cnf_segments); found = TRUE; } last_help = help; help = help->next; } if (!found) { /* * No affected NPDU found. */ if (ll_data_cnf != NULL) { TRACE_EVENT("No affected NPDU found."); PFREE(ll_data_cnf); } return; } /* * If the affected N-PDU is completely confirmed, notify service nu and * free last_help. */ TRACE_EVENT_P1("last_help->number_of_segments: %d", last_help->number_of_segments); TRACE_EVENT_P1("last_help->cnf_segments: %d", last_help->cnf_segments); if (last_help->number_of_segments == SNDCP_SEGMENT_NUMBERS_ACK) { if (last_help->cnf_segments == SNDCP_MAX_COMPLETE /*4294967295 == 2**32 - 1*/) { complete = TRUE; } } else if (last_help->cnf_segments == ((ULONG)(1 << last_help->number_of_segments) - 1)) { complete = TRUE; } if (complete) { /* * Notify service nu. */ sig_sua_nu_data_cnf (ll_data_cnf->reference1[refi].ref_nsapi, (UBYTE)ll_data_cnf->reference1[refi].ref_npdu_num); /* * Free last_help. */ help = sndcp_data->sua->first_seg_info; if (help == last_help) { sndcp_data->sua->first_seg_info = help->next; MFREE(help); help = NULL; } else { T_SEG_INFO* help_next = help->next; while (help->next != last_help) { help = help->next; } help_next = help->next; help->next = help_next->next; MFREE (help_next); } } } /* for refi */ break; default: TRACE_ERROR( "LL_DATA_CNF unexpected" ); break; } if (ll_data_cnf != NULL) { PFREE(ll_data_cnf); } } /* sua_ll_data_cnf() */ #ifdef _SNDCP_DTI_2_ /* +------------------------------------------------------------------------------ | Function : sua_ll_ready_ind +------------------------------------------------------------------------------ | Description : Handles the primitive LL_READY_IND | | Parameters : *ll_ready_ind - Ptr to primitive payload | +------------------------------------------------------------------------------ */ GLOBAL void sua_ll_ready_ind ( T_LL_READY_IND *ll_ready_ind ) { U8 sapi_index = 0; TRACE_FUNCTION( "sua_ll_ready_ind" ); /* * set service instance according to sapi in primitive */ sndcp_get_sapi_index(ll_ready_ind->sapi, &sapi_index); sndcp_data->sua = & sndcp_data->sua_base[sapi_index]; switch( GET_STATE( SUA ) ) { case SUA_LLC_NOT_RECEPTIVE_SUSPEND: /* * Is queue with outgoing LL_DESC_REQs empty? */ if (sndcp_data->sua->ll_desc_q_read == sndcp_data->sua->ll_desc_q_write) { if (sndcp_data->sua->cia_state == CIA_IDLE) { sua_next_sn_data_req(ll_ready_ind->sapi); } } SET_STATE(SUA, SUA_LLC_RECEPTIVE_SUSPEND); break; case SUA_LLC_RECEPTIVE_SUSPEND: break; case SUA_LLC_NOT_RECEPTIVE: /* * Is queue with outgoing LL_DESC_REQs empty? */ if (sndcp_data->sua->ll_desc_q_read == sndcp_data->sua->ll_desc_q_write) { SET_STATE(SUA, SUA_LLC_RECEPTIVE); if (sndcp_data->sua->cia_state == CIA_IDLE) { sua_next_sn_data_req(ll_ready_ind->sapi); } } else { /* sndcp_data->sua.ll_desc_q is not empty */ /* * Send next ll_desc_req from queue. */ T_LL_DESC_REQ* ll_desc_req = sndcp_data->sua->ll_desc_q[sndcp_data->sua->ll_desc_q_read]; U8 ll_desc_sapi = ll_desc_req->sapi; U8 ll_desc_seg_pos = ll_desc_req->seg_pos; U8 ll_desc_nsapi = sua_get_nsapi(ll_desc_req); sndcp_data->sua->ll_desc_q[sndcp_data->sua->ll_desc_q_read] = NULL; sndcp_data->sua->ll_desc_q_read = (sndcp_data->sua->ll_desc_q_read + 1) % SNDCP_SEGMENT_NUMBERS_ACK; #ifdef _SIMULATION_ su_send_ll_data_req_test(ll_desc_req); #else /* _SIMULATION_ */ PSEND(hCommLLC, ll_desc_req); #endif /* _SIMULATION_ */ if ((ll_desc_seg_pos & SEG_POS_LAST) > 0) { sig_sua_nu_ready_ind( ll_desc_nsapi ); sua_next_sn_data_req( ll_desc_sapi ); sndcp_data->sua->cia_state = CIA_IDLE; } } /* sndcp_data->sua.ll_desc_q is not empty */ break; case SUA_LLC_RECEPTIVE: break; default: TRACE_ERROR( "LL_READY_IND unexpected" ); break; } if (ll_ready_ind != NULL) { PFREE (ll_ready_ind); } } /* su_ll_ready_ind() */ #else /* _SNDCP_DTI_2_ */ /* +------------------------------------------------------------------------------ | Function : sua_ll_ready_ind +------------------------------------------------------------------------------ | Description : Handles the primitive LL_READY_IND | | Parameters : *ll_ready_ind - Ptr to primitive payload | +------------------------------------------------------------------------------ */ GLOBAL void sua_ll_ready_ind ( T_LL_READY_IND *ll_ready_ind ) { UBYTE sapi_index = 0; TRACE_FUNCTION( "sua_ll_ready_ind" ); /* * set service instance according to sapi in primitive */ sndcp_get_sapi_index(ll_ready_ind->sapi, &sapi_index); sndcp_data->sua = & sndcp_data->sua_base[sapi_index]; switch( GET_STATE( SUA ) ) { case SUA_LLC_NOT_RECEPTIVE_SUSPEND: /* * Is queue with outgoing LL_DATA_REQs empty? */ if (sndcp_data->sua->ll_data_q_read == sndcp_data->sua->ll_data_q_write) { if (sndcp_data->sua->cia_state == CIA_IDLE) { sua_next_sn_data_req(ll_ready_ind->sapi); } } SET_STATE(SUA, SUA_LLC_RECEPTIVE_SUSPEND); break; case SUA_LLC_RECEPTIVE_SUSPEND: break; case SUA_LLC_NOT_RECEPTIVE: /* * Is queue with outgoing LL_DATA_REQs empty? */ if (sndcp_data->sua->ll_data_q_read == sndcp_data->sua->ll_data_q_write) { SET_STATE(SUA, SUA_LLC_RECEPTIVE); if (sndcp_data->sua->cia_state == CIA_IDLE) { sua_next_sn_data_req(ll_ready_ind->sapi); } } else { /* sndcp_data->sua.ll_data_q is not empty */ /* * Send next ll_data_req from queue. */ T_LL_DATA_REQ* ll_data_req = sndcp_data->sua->ll_data_q[sndcp_data->sua->ll_data_q_read]; UBYTE ll_data_sapi = ll_data_req->sapi; UBYTE ll_data_seg_pos = ll_data_req->seg_pos; UBYTE ll_data_nsapi = sua_get_nsapi(ll_data_req); sndcp_data->sua->ll_data_q[sndcp_data->sua->ll_data_q_read] = NULL; sndcp_data->sua->ll_data_q_read = (sndcp_data->sua->ll_data_q_read + 1) % SNDCP_SEGMENT_NUMBERS_ACK; PSEND (hCommLLC, ll_data_req); if ((ll_data_seg_pos & SEG_POS_LAST) > 0) { sig_sua_nu_ready_ind( ll_data_nsapi ); sua_next_sn_data_req( ll_data_sapi ); sndcp_data->sua->cia_state = CIA_IDLE; } } /* sndcp_data->sua.ll_data_q is not empty */ break; case SUA_LLC_RECEPTIVE: break; default: TRACE_ERROR( "LL_READY_IND unexpected" ); break; } if (ll_ready_ind != NULL) { PFREE (ll_ready_ind); } } /* su_ll_ready_ind() */ #endif /* _SNDCP_DTI_2_ */