FreeCalypso > hg > fc-tourmaline
view src/g23m-gprs/sm/sm_dispatch_message.c @ 221:5bf097aeaad7
LLS: when turning off all LEDs on boot, skip LED-C
Having LLS turn off LED-A and LED-B on boot is normally unnecessary
(they should already be off in Iota), but it is harmless, hence this
logic is kept for robustness. However, having LLS read-modify-write
the BCICTL2 register (to turn off LED-C) creates a potential race
condition with FCHG writes to this register, especially in the case
when baseband switch-on is caused by VCHG and charging is expected
to start right away. Furthermore, control of the charging LED itself
(on those hw targets that have it) is the responsibility of the FCHG
SWE, hence LLS should leave it alone.
author | Mychaela Falconia <falcon@freecalypso.org> |
---|---|
date | Mon, 26 Apr 2021 21:55:13 +0000 |
parents | fa8dc04885d8 |
children |
line wrap: on
line source
/*---------------------------------------------------------------------------- | Project : 3G PS | Module : SM +----------------------------------------------------------------------------- | Copyright 2003 Texas Instruments. | All rights reserved. | | This file is confidential and a trade secret of Texas | Instruments . | 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. +----------------------------------------------------------------------------- | Purpose: This module implements the process dispatcher for incoming | air interface messages in the Session Management (SM) entity. | For design details, see: | 8010.908 SM Detailed Specification +---------------------------------------------------------------------------*/ /*==== DECLARATION CONTROL =================================================*/ /*==== INCLUDES =============================================================*/ #include "sm.h" #include "ccdapi.h" #include "sm_network_control.h" #include "sm_aci_output_handler.h" #include "sm_mm_output_handler.h" /*==== CONSTS ===============================================================*/ /*==== TYPES ================================================================*/ /*==== LOCALS ===============================================================*/ /*==== PRIVATE FUNCTIONS ====================================================*/ /*==== PUBLIC FUNCTIONS =====================================================*/ /* +------------------------------------------------------------------------------ | Function : sm_disp_mmpm_unitdata_ind +------------------------------------------------------------------------------ | Description : Dispatch MMPM_UNITDATA_IND | | Parameters : prim - received primitive +------------------------------------------------------------------------------ */ void sm_disp_mmpm_unitdata_ind(T_MMPM_UNITDATA_IND *prim) { U8 ti, ti_flag, msg_type, *msg, ccdResult; U16 offset; struct T_SM_CONTEXT_DATA *context; T_CAUSE_ps_cause cause; (void)TRACE_FUNCTION("sm_disp_mmpm_unitdata_ind"); offset = (U16)(prim->sdu.o_buf + 7) >> 3; /* Offset in octets/bytes in message buffer */ msg = &prim->sdu.buf[offset]; /* Read L3 header: First TI/PD octet */ ti_flag = (msg[0] & SM_TI_FLAG) == (U8)0 ? (U8)SM_TI_FLAG : (U8)0; ti = (msg[0] >> 4) & SM_TI_NON_EXT_MASK; /* Check for extended TI: If TI == 7, read next octet for real TI */ if (ti == (U8)SM_TI_EXTEND_VALUE) { ti = msg[1]; /* Read real TI from next octet in message */ if ((ti & (U8)SM_TI_FLAG) == (U8)0) { /* Messages with TI EXT bit = 0 shall be ignored: [3G 24.008, 8.3.2] */ (void)TRACE_ERROR("Warning: TI EXT bit = 0 in message - message ignored!"); return; } else { ti &= SM_TI_MASK; } offset = (U16)16; /* # bits to advance message pointer to reach message type */ msg_type = msg[2]; /* Get message type octet after TI */ (void)TRACE_EVENT_P1(" Extended TI found: 0x%02x", ti); } else { offset = (U16)8; /* # bits to advance message pointer to reach message type */ (void)TRACE_EVENT_P1(" Non-extended TI found: 0x%02x", ti); msg_type = msg[1]; /* Get message type octet after TI */ } /* Set highest bit iff the direction flag bit was set above */ ti |= ti_flag; /* Advance message pointer past TI/PD octet(s) */ prim->sdu.l_buf -= offset; prim->sdu.o_buf += offset; /* Check for message too short: [3G 24.008, 8.2] */ if (prim->sdu.l_buf < (U16)8) { (void)TRACE_ERROR("Warning! Message too short - discarded..."); return; } /* Find context with TI = ti, if already active/being activated */ context = sm_get_context_data_from_ti(ti); switch (msg_type) { case ACTIVATE_PDP_CONTEXT_ACCEPT: case ACTIVATE_PDP_CONTEXT_REJECT: case ACTIVATE_SECONDARY_PDP_CONTEXT_ACCEPT: case ACTIVATE_SECONDARY_PDP_CONTEXT_REJECT: case D_MODIFY_PDP_CONTEXT_REQUEST: case D_MODIFY_PDP_CONTEXT_ACCEPT: case MODIFY_PDP_CONTEXT_REJECT: case DEACTIVATE_PDP_CONTEXT_REQUEST: case DEACTIVATE_PDP_CONTEXT_ACCEPT: if (context == NULL) { /* Message received on TI not relating to an active context, or context * being activated/deactivated: [3G 24.008, 8.3.2 b)]*/ (void)TRACE_ERROR("Message received on TI not relating to an active context, or context being activated/deactivated"); cause.ctrl_value = CAUSE_is_from_nwsm; cause.value.nwsm_cause = (U16)CAUSE_NWSM_INVALID_TI; send_msg_sm_status(ti, &cause); return; } break; case REQUEST_PDP_CONTEXT_ACTIVATION: if (ti_flag == (U8)0) { /* Ignore REQUEST PDP CONTEXT ACTIVATION msg with TI flag = 1 [3G 24.008, 8.3.2 c)] */ /* Note: flag bit is inverted above! */ (void)TRACE_EVENT("REQUEST PDP CONTEXT ACTIVATION msg with TI flag = 1 ignored..."); return; } if (context == NULL) { /* If no context exists for the TI, create one. */ context = sm_insert_mt_context_data(ti); } break; case SM_STATUS: if (context == NULL) { /* Silently ignore message */ return; } break; case ACTIVATE_PDP_CONTEXT_REQUEST: /* FALL-THROUGH */ case ACTIVATE_SECONDARY_PDP_CONTEXT_REQUEST: /* FALL-THROUGH */ case REQUEST_PDP_CONTEXT_ACTIVATION_REJECT: /* FALL-THROUGH */ case U_MODIFY_PDP_CONTEXT_REQUEST: /* FALL-THROUGH */ case U_MODIFY_PDP_CONTEXT_ACCEPT: /* FALL-THROUGH */ default: /* Message type not defined for the PD in the given direction: [3G 24.008, 8.4] */ (void)TRACE_ERROR("Message type not defined for the PD in the given direction"); cause.ctrl_value = CAUSE_is_from_nwsm; cause.value.nwsm_cause = (U16)CAUSE_NWSM_MSG_TYPE_NOT_IMPLEMENTED; send_msg_sm_status(ti, &cause); return; } /* switch */ TRACE_ASSERT(context != NULL); /* Decode message */ ccdResult = ccd_decodeMsg((U8)CCDENT_SM, (U8)DOWNLINK, (T_MSGBUF *)&prim->sdu, (UBYTE *) _decodedMsg, (U8)NOT_PRESENT_8BIT); if (ccdResult != (U8)ccdOK) { /* Error Handling */ U16 parlist[6]; U8 first_err; U8 ccd_err; /* clear parlist */ memset (parlist, 0, sizeof (parlist)); first_err = ccd_getFirstError((U8)CCDENT_SM, parlist); ccd_err = first_err; /* Loop over errors in parlist. Fix inherited from TI Berlin. */ do { /* Error Handling */ switch (ccd_err) { case ERR_COMPREH_REQUIRED: /* Comprehension required */ case ERR_MAND_ELEM_MISS: { /* Mandatory elements missing */ (void)TRACE_ERROR("CCD ERROR: Mandatory elements missing"); if (msg_type == (U8)DEACTIVATE_PDP_CONTEXT_REQUEST) { /* [3G 24.008, 8.5.5]: If msg_type is DEACTIVATE PDP CONTEXT REQUEST, * respond with DEACTIVATE PDP CONTEXT ACCEPT and release context. */ send_msg_deactivate_pdp_context_accept(context); } else if (msg_type == (U8)REQUEST_PDP_CONTEXT_ACTIVATION) { /* [3G 24.008, 8.5.5]: If msg_type is REQUEST PDP CONTEXT ACTIVATION, * respond with SM STATUS, cause #96 "invalid mandatory information". */ cause.ctrl_value = CAUSE_is_from_nwsm; cause.value.nwsm_cause = (U16)CAUSE_NWSM_INVALID_MANDATORY_ELEMENT; send_msg_sm_status(ti, &cause); return; } else { cause.ctrl_value = CAUSE_is_from_nwsm; cause.value.nwsm_cause = (U16)CAUSE_NWSM_INVALID_MANDATORY_ELEMENT; send_msg_sm_status(ti, &cause); return; } /*@switchbreak@*/ break; } } /* switch */ ccd_err = ccd_getNextError ((U8)CCDENT_SM, parlist); } while (ccd_err != (U8)ERR_NO_MORE_ERROR); } /* if (ccdResult...) */ switch (msg_type) { case ACTIVATE_PDP_CONTEXT_ACCEPT: /* Forward to Network Control */ sm_network_control(context, SM_M_ACTIVATE_PDP_CONTEXT_ACCEPT, _decodedMsg); break; case ACTIVATE_PDP_CONTEXT_REJECT: /* Forward to Network Control */ sm_network_control(context, SM_M_ACTIVATE_PDP_CONTEXT_REJECT, _decodedMsg); break; case ACTIVATE_SECONDARY_PDP_CONTEXT_ACCEPT: /* Forward to Network Control */ sm_network_control(context, SM_M_ACTIVATE_SECONDARY_PDP_CONTEXT_ACCEPT, _decodedMsg); break; case ACTIVATE_SECONDARY_PDP_CONTEXT_REJECT: /* Forward to Network Control */ sm_network_control(context, SM_M_ACTIVATE_SECONDARY_PDP_CONTEXT_REJECT, _decodedMsg); break; case REQUEST_PDP_CONTEXT_ACTIVATION: /* Forward to Network Control */ sm_network_control(context, SM_M_REQUEST_PDP_CONTEXT_ACTIVATION, _decodedMsg); break; case D_MODIFY_PDP_CONTEXT_REQUEST: /* Forward to Network Control */ sm_network_control(context, SM_M_MODIFY_PDP_CONTEXT_REQUEST, _decodedMsg); break; case D_MODIFY_PDP_CONTEXT_ACCEPT: /* Forward to Network Control */ sm_network_control(context, SM_M_MODIFY_PDP_CONTEXT_ACCEPT, _decodedMsg); break; case MODIFY_PDP_CONTEXT_REJECT: /* Forward to Network Control */ sm_network_control(context, SM_M_MODIFY_PDP_CONTEXT_REJECT, _decodedMsg); break; case DEACTIVATE_PDP_CONTEXT_REQUEST: /* Forward to Network Control */ sm_network_control(context, SM_M_DEACTIVATE_PDP_CONTEXT_REQUEST, _decodedMsg); break; case DEACTIVATE_PDP_CONTEXT_ACCEPT: /* Forward to Network Control */ sm_network_control(context, SM_M_DEACTIVATE_PDP_CONTEXT_ACCEPT, _decodedMsg); break; case SM_STATUS: /* Forward to Network Control */ sm_network_control(context, SM_M_SM_STATUS, _decodedMsg); break; } /* switch */ /* Deallocate context if it was marked for deactivation by the above operation */ /*lint -e613 (Possible use of null pointer 'context' in left argument to operator '->') */ if (sm_is_context_pending_deallocation(context)) { sm_free_context_data_by_nsapi(context->nsapi); } } /*==== END OF FILE ==========================================================*/