FreeCalypso > hg > fc-tourmaline
view src/g23m-gsm/ss/ss_ss.c @ 78:c632896652ba
mfw/ti1_key.c: properly initialize notified_keys array
The code in this ti1_key.c layer needs to call kpd_subscribe() and
kpd_define_key_notification() functions in order to register with the
KPD driver. The original code passed KPD_NB_PHYSICAL_KEYS in
nb_notified_keys - this constant is defined to 24 in kpd_cfg.h on all
platforms of interest to us - but it only filled the first 23 slots
in the notified_keys array, resulting in stack garbage being passed
to KPD API functions. The fix consists of initializing the last
missed array slot to KPD_KEY_RECORD, the key ID for the right side
button on the D-Sample handset.
On our current hw targets this "Record" button exists as the EXTRA
button on our Luna keypad board and as the camera button on the
Pirelli DP-L10. There is no support whatsoever for this button
in current BMI+MFW, we have no plans of doing anything with Pirelli's
camera button even if we do get our UI fw running on that phone,
and the Mother's dream of building our own FreeCalypso handset with
the same button arrangement as D-Sample (including the right side
button) is currently very nebulous - but let us nonetheless handle
the full set of buttons on the KPD to MFW interface, and let upper
layers weed out unsupported buttons.
author | Mychaela Falconia <falcon@freecalypso.org> |
---|---|
date | Sun, 25 Oct 2020 23:41:01 +0000 |
parents | fa8dc04885d8 |
children |
line wrap: on
line source
/* +----------------------------------------------------------------------------- | 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 functions for the supplementary | services. +----------------------------------------------------------------------------- */ #ifndef SS_SS_C #define SS_SS_C #define ENTITY_SS /*==== INCLUDES ===================================================*/ #if defined (NEW_FRAME) #include <string.h> #include <stdlib.h> #include <stddef.h> #include "typedefs.h" #include "pcm.h" #include "pconst.cdg" #include "mconst.cdg" #include "message.h" #include "ccdapi.h" #include "vsi.h" #include "custom.h" #include "gsm.h" #include "prim.h" #include "cnf_ss.h" #include "mon_ss.h" #include "pei.h" #include "tok.h" #include "ss.h" #include "ss_em.h" #else #include <string.h> #include <stdlib.h> #include <stddef.h> #include "stddefs.h" #include "pcm.h" #include "pconst.cdg" #include "mconst.cdg" #include "message.h" #include "ccdapi.h" #include "custom.h" #include "gsm.h" #include "prim.h" #include "cnf_ss.h" #include "mon_ss.h" #include "vsi.h" #include "pei.h" #include "tok.h" #include "ss.h" #include "ss_em.h" #endif /*==== EXPORT =====================================================*/ /*==== PRIVAT =====================================================*/ /*==== VARIABLES ==================================================*/ #ifdef TI_PS_HCOMM_CHANGE #else #if defined (NEW_FRAME) EXTERN T_HANDLE hCommMM; /* MM Communication */ EXTERN T_HANDLE hCommMMI; /* MMI Communication */ #else EXTERN T_VSI_CHANDLE hCommMM; /* MM Communication */ EXTERN T_VSI_CHANDLE hCommMMI; /* MMI Communication */ #endif #endif #ifdef SS_TEST UBYTE trc[100]; #endif /*==== FUNCTIONS ==================================================*/ /* * ------------------------------------------------------------------- * PRIMITIVE Processing functions * ------------------------------------------------------------------- */ /* +--------------------------------------------------------------------+ | PROJECT : GSM-PS (6147) MODULE : SS_SS | | STATE : code ROUTINE : ss_init_ss_data | +--------------------------------------------------------------------+ PURPOSE : Initialize the SS data for the module supplem. services. */ GLOBAL void ss_init_ss_data (void) { GET_INSTANCE_DATA; UBYTE i; TRACE_FUNCTION ("ss_init_ss_data()"); ss_init (); for (i = 0; i < MAX_INST; i++) SET_SS_STATE(ss_data->ss_state,i,SS_IDLE); /*lint !e502 (Warning -- Warning 502: Expected unsigned type ) */ } /* +--------------------------------------------------------------------+ | PROJECT : GSM-PS (6147) MODULE : SS_SS | | STATE : code ROUTINE : ss_mmss_error_ind | +--------------------------------------------------------------------+ PURPOSE : Process the primitive MMSS_ERROR_IND. */ GLOBAL void ss_mmss_error_ind (T_MMSS_ERROR_IND *mmss_error_ind) { GET_INSTANCE_DATA; TRACE_FUNCTION ("ss_mmss_error_ind()"); ss_data->ti = mmss_error_ind->ti; switch (GET_SS_STATE(ss_data->ss_state,ss_data->ti)) { case SS_CONNECTION_PENDING: PFREE (P2D(ss_data->prim[ss_data->ti])); ss_data->prim[ss_data->ti] = NULL; /*FALLTHROUGH*/ case SS_CONNECTED: { PALLOC (mnss_end_ind, MNSS_END_IND); ss_data->ti = mmss_error_ind->ti; mnss_end_ind->cause = mmss_error_ind->cause; mnss_end_ind->ti = ss_data->ti; memset (&mnss_end_ind->fac_inf, 0, sizeof (T_fac_inf)) ; SET_SS_STATE(ss_data->ss_state,ss_data->ti,SS_IDLE); /*lint !e502 (Warning -- Warning 502: Expected unsigned type ) */ PSENDX (MMI, mnss_end_ind); { PALLOC (mmss_release_req, MMSS_RELEASE_REQ); mmss_release_req->ti = ss_data->ti; PSENDX (MM, mmss_release_req); } MM_EM_MM_CONNECTION_ABORTED; break; } default: break; } PFREE (mmss_error_ind); } /* +--------------------------------------------------------------------+ | PROJECT : GSM-PS (6147) MODULE : SS_SS | | STATE : code ROUTINE : ss_mmss_establish_cnf | +--------------------------------------------------------------------+ PURPOSE : Process the primitive MMSS_ESTABLISH_CNF. */ GLOBAL void ss_mmss_establish_cnf (T_MMSS_ESTABLISH_CNF *mmss_establish_cnf) { GET_INSTANCE_DATA; TRACE_FUNCTION ("ss_mmss_establish_cnf()"); ss_data->ti = mmss_establish_cnf->ti; switch (GET_SS_STATE(ss_data->ss_state,ss_data->ti)) { case SS_CONNECTION_PENDING: CCD_START; { T_MNSS_BEGIN_REQ * mnss_begin_req; MCAST (ss_register, U_SS_REGISTER); ss_register->msg_type = U_SS_REGISTER; mnss_begin_req = (T_MNSS_BEGIN_REQ *)P2D(ss_data->prim[ss_data->ti]); ss_register->ss_version.c_ver = mnss_begin_req->ss_ver.len; if(ss_register->ss_version.c_ver) { ss_register->v_ss_version = TRUE; memcpy (ss_register->ss_version.ver, mnss_begin_req->ss_ver.ver, ss_register->ss_version.c_ver); } else { ss_register->v_ss_version = FALSE; } ss_register->ss_facility.c_fac_info = mnss_begin_req->fac_inf.l_fac >> 3; if(ss_register->ss_facility.c_fac_info) { ss_register->v_ss_facility = TRUE; memcpy (ss_register->ss_facility.fac_info, &mnss_begin_req->fac_inf.fac[mnss_begin_req->fac_inf.o_fac >>3], ss_register->ss_facility.c_fac_info); } else { ss_register->v_ss_facility = FALSE; } SET_SS_STATE(ss_data->ss_state,ss_data->ti,SS_CONNECTED); /*lint !e502 (Warning -- Warning 502: Expected unsigned type ) */ PFREE (P2D(ss_data->prim[ss_data->ti])); ss_data->prim[ss_data->ti] = NULL; ss_for_data_req ((USHORT)(LEN_U_SS_REGISTER + ss_register->ss_facility.c_fac_info * 8)); MM_EM_MM_CONNECTION_ESTABLISHED; } CCD_END; break; default: break; } PFREE (mmss_establish_cnf); } /* +--------------------------------------------------------------------+ | PROJECT : GSM-PS (6147) MODULE : SS_SS | | STATE : code ROUTINE : ss_mmss_release_ind | +--------------------------------------------------------------------+ PURPOSE : Process the primitive MMSS_RELEASE_IND. */ GLOBAL void ss_mmss_release_ind (T_MMSS_RELEASE_IND *mmss_release_ind) { GET_INSTANCE_DATA; TRACE_FUNCTION ("ss_mmss_release_ind()"); ss_data->ti = mmss_release_ind->ti; switch (GET_SS_STATE(ss_data->ss_state,ss_data->ti)) { case SS_CONNECTION_PENDING: PFREE (P2D(ss_data->prim[ss_data->ti])); ss_data->prim[ss_data->ti] = NULL; MM_EM_MM_CONNECTION_FAILED; /*FALLTHROUGH*/ case SS_CONNECTED: { PALLOC (mnss_end_ind, MNSS_END_IND); mnss_end_ind->ti = ss_data->ti; mnss_end_ind->cause = mmss_release_ind->cause; memset (&mnss_end_ind->fac_inf, 0, sizeof (T_fac_inf)); SET_SS_STATE(ss_data->ss_state,ss_data->ti,SS_IDLE); /*lint !e502 (Warning -- Warning 502: Expected unsigned type ) */ MM_EM_MM_CONNECTION_RELEASED; PSENDX (MMI, mnss_end_ind); break; } default: break; } PFREE (mmss_release_ind); } /* +--------------------------------------------------------------------+ | PROJECT : GSM-PS (6147) MODULE : SS_SS | | STATE : code ROUTINE : ss_mnss_begin_req | +--------------------------------------------------------------------+ PURPOSE : Process the primitive MNSS_BEGIN_REQ. */ GLOBAL void ss_mnss_begin_req (T_MNSS_BEGIN_REQ *mnss_begin_req) { GET_INSTANCE_DATA; TRACE_FUNCTION ("ss_mnss_begin_req()"); ss_data->ti = mnss_begin_req->ti; switch (GET_SS_STATE(ss_data->ss_state,ss_data->ti)) { case SS_IDLE: { if (ss_data->ti < 7) { #if defined (NEW_FRAME) ss_data->prim[ss_data->ti] = (T_PRIM *)D2P(mnss_begin_req); #else ss_data->prim[ss_data->ti] = D2P(mnss_begin_req); #endif { PALLOC (mmss_establish_req, MMSS_ESTABLISH_REQ); mmss_establish_req->ti = ss_data->ti; SET_SS_STATE(ss_data->ss_state,ss_data->ti,SS_CONNECTION_PENDING); /*lint !e502 (Warning -- Warning 502: Expected unsigned type ) */ PSENDX (MM, mmss_establish_req); MM_EM_MM_CONNECTION_STARTED; } return; /* Don't free primitive */ } break; } default: break; } PFREE (mnss_begin_req); } /* +--------------------------------------------------------------------+ | PROJECT : GSM-PS (6147) MODULE : SS_SS | | STATE : code ROUTINE : ss_mnss_end_req | +--------------------------------------------------------------------+ PURPOSE : Process the primitive MNSS_END_REQ. */ GLOBAL void ss_mnss_end_req (T_MNSS_END_REQ *mnss_end_req) { GET_INSTANCE_DATA; TRACE_FUNCTION ("ss_mnss_end_req()"); ss_data->ti = mnss_end_req->ti; switch (GET_SS_STATE(ss_data->ss_state,ss_data->ti)) { case SS_CONNECTION_PENDING: if (ss_data->prim[ss_data->ti] NEQ NULL) { /* Free stored primitive */ PFREE (P2D(ss_data->prim[ss_data->ti])); ss_data->prim[ss_data->ti] = NULL; } /* Send MMSS_RELEASE_REQ */ { PALLOC (mmss_release_req, MMSS_RELEASE_REQ); /* T_MMSS_RELEASE_REQ */ mmss_release_req->ti = ss_data->ti; PSENDX (MM, mmss_release_req); } /* Next state is SS_IDLE */ SET_SS_STATE(ss_data->ss_state,ss_data->ti,SS_IDLE); /*lint !e502 (Warning -- Warning 502: Expected unsigned type ) */ break; case SS_CONNECTED: CCD_START; { MCAST (ss_rel_comp, B_SS_REL_COMP); ss_rel_comp->msg_type = B_SS_REL_COMP; ss_rel_comp->v_ss_cause = FALSE; ss_rel_comp->v_ss_facility = (mnss_end_req->fac_inf.l_fac) ? TRUE : FALSE; ss_rel_comp->ss_facility.c_fac_info = mnss_end_req->fac_inf.l_fac >> 3; memcpy (ss_rel_comp->ss_facility.fac_info, &mnss_end_req->fac_inf.fac[mnss_end_req->fac_inf.o_fac >>3], ss_rel_comp->ss_facility.c_fac_info); if (ss_rel_comp->v_ss_facility) { ss_for_data_req ((USHORT)(LEN_U_SS_RELEASE_COMPLETE + ss_rel_comp->ss_facility.c_fac_info * 8)); } else { ss_for_data_req (LEN_U_SS_RELEASE_COMPLETE); } { PALLOC (mmss_release_req, MMSS_RELEASE_REQ); mmss_release_req->ti = ss_data->ti; ss_data->ss_state = SET_SS_STATE(ss_data->ss_state,ss_data->ti,SS_IDLE); /*lint !e502 (Warning -- Warning 502: Expected unsigned type ) */ PSENDX (MM, mmss_release_req); } } CCD_END; MM_EM_MM_RELEASE_COMPLETE_SENT; break; } PFREE (mnss_end_req); } /* +--------------------------------------------------------------------+ | PROJECT : GSM-PS (6147) MODULE : SS_SS | | STATE : code ROUTINE : ss_mnss_facility_req | +--------------------------------------------------------------------+ PURPOSE : Process the primitive MNSS_FACILITY_REQ. */ GLOBAL void ss_mnss_facility_req (T_MNSS_FACILITY_REQ *mnss_facility_req) { GET_INSTANCE_DATA; CCD_START; { MCAST (ss_facility, U_SS_FACILITY); TRACE_FUNCTION ("ss_mnss_facility_req()"); switch (GET_SS_STATE(ss_data->ss_state,ss_data->ti)) { case SS_CONNECTED: ss_data->ti = mnss_facility_req->ti; ss_facility->msg_type = U_SS_FACILITY; ss_facility->ss_facility.c_fac_info = mnss_facility_req->fac_inf.l_fac >> 3; memcpy (ss_facility->ss_facility.fac_info, &mnss_facility_req->fac_inf.fac[mnss_facility_req->fac_inf.o_fac >>3], ss_facility->ss_facility.c_fac_info); ss_for_data_req ((USHORT)(LEN_U_SS_FACILITY + ss_facility->ss_facility.c_fac_info * 8)); MM_EM_FACILITY_MESSAGE_SENT; break; default: break; } } CCD_END; PFREE (mnss_facility_req); } /* * ------------------------------------------------------------------- * SIGNAL Processing functions * ------------------------------------------------------------------- */ /* +--------------------------------------------------------------------+ | PROJECT : GSM-PS (6147) MODULE : SS_SS | | STATE : code ROUTINE : ss_b_ss_rel_comp | +--------------------------------------------------------------------+ PURPOSE : Process the signal B_SS_REL_COMP. */ GLOBAL void ss_b_ss_rel_comp (void) { GET_INSTANCE_DATA; TRACE_FUNCTION ("ss_b_ss_rel_comp()"); switch (GET_SS_STATE(ss_data->ss_state,ss_data->ti)) { case SS_IDLE: /* Unrecognised TI : Ignore Message TS 24.010 Section 3.7.3 a)*/ { PALLOC (mmss_release_req, MMSS_RELEASE_REQ); /* T_MMSS_RELEASE_REQ */ mmss_release_req->ti = ss_data->ti; PSENDX (MM, mmss_release_req); } break; case SS_CONNECTED: if (! ss_data->est_flag) { MCAST (ss_rel_comp, B_SS_REL_COMP); PALLOC (mnss_end_ind, MNSS_END_IND); mnss_end_ind->ti = ss_data->ti; if (ss_rel_comp->v_ss_cause) mnss_end_ind->cause = CAUSE_MAKE(DEFBY_STD, ORIGSIDE_NET, SS_ORIGINATING_ENTITY, ss_rel_comp->ss_cause.cs); else mnss_end_ind->cause = CAUSE_MAKE(DEFBY_CONDAT, ORIGSIDE_NET, SS_ORIGINATING_ENTITY, NOT_PRESENT_8BIT); memcpy (mnss_end_ind->fac_inf.fac, ss_rel_comp->ss_facility.fac_info, ss_rel_comp->ss_facility.c_fac_info); mnss_end_ind->fac_inf.l_fac = ss_rel_comp->ss_facility.c_fac_info << 3; mnss_end_ind->fac_inf.o_fac = 0; SET_SS_STATE(ss_data->ss_state,ss_data->ti,SS_IDLE); /*lint !e502 (Warning -- Warning 502: Expected unsigned type ) */ PSENDX (MMI, mnss_end_ind); { PALLOC (mmss_release_req, MMSS_RELEASE_REQ); mmss_release_req->ti = ss_data->ti; PSENDX (MM, mmss_release_req); } MM_EM_MM_RELEASE_COMPLETE_RECEIVED; } break; default: /* Should never reach here */ TRACE_FUNCTION("**BAD SS State**"); break; } } /* +--------------------------------------------------------------------+ | PROJECT : GSM-PS (6147) MODULE : SS_SS | | STATE : code ROUTINE : ss_d_ss_facility | +--------------------------------------------------------------------+ PURPOSE : Process the signal D_SS_FACILITY. */ GLOBAL void ss_d_ss_facility (void) { GET_INSTANCE_DATA; TRACE_FUNCTION ("ss_d_ss_facility()"); switch( ss_data->error ) { case CAUSE_INVALID_MAND_INFO: /* Send RELEASE COMPLETE with this cause TS 24.010 Section 3.7.4*/ send_rel_comp(CAUSE_INVALID_MAND_INFO); return; default: break; } switch (GET_SS_STATE(ss_data->ss_state,ss_data->ti)) { case SS_IDLE: /* Unrecognised TI : TS 24.010 Section 3.7.3 b)*/ send_rel_comp(CAUSE_INVALID_TI); break; case SS_CONNECTED: { MCAST (ss_facility, U_SS_FACILITY); if (! ss_data->est_flag) { PALLOC (mnss_facility_ind, MNSS_FACILITY_IND); mnss_facility_ind->ti = ss_data->ti; memcpy (mnss_facility_ind->fac_inf.fac, ss_facility->ss_facility.fac_info, ss_facility->ss_facility.c_fac_info); mnss_facility_ind->fac_inf.l_fac = ss_facility->ss_facility.c_fac_info << 3; mnss_facility_ind->fac_inf.o_fac = 0; MM_EM_FACILITY_MESSAGE_RECEIVED; PSENDX (MMI, mnss_facility_ind); } break; } default: /* Should never reach here */ TRACE_FUNCTION("**BAD SS State**"); break; } } /* +--------------------------------------------------------------------+ | PROJECT : GSM-PS (6147) MODULE : SS_SS | | STATE : code ROUTINE : ss_d_ss_register | +--------------------------------------------------------------------+ PURPOSE : Process the signal D_SS_REGISTER. */ GLOBAL void ss_d_ss_register (void) { GET_INSTANCE_DATA; MCAST (ss_register, U_SS_REGISTER); TRACE_FUNCTION ("ss_d_ss_register()"); switch( ss_data->error ) { case CAUSE_INVALID_MAND_INFO: /* Send RELEASE COMPLETE with this cause TS 24.010 Section 3.7.4*/ send_rel_comp(CAUSE_INVALID_MAND_INFO); return; default: break; } switch (GET_SS_STATE(ss_data->ss_state,ss_data->ti)) { case SS_CONNECTED: /* This TI is already being used therefore ignore Message */ /* TS 24.010 Section 3.7.3 c) */ break; case SS_IDLE: if (ss_data->est_flag AND (ss_data->ti >= 8 AND ss_data->ti < 15)) { PALLOC (mnss_begin_ind, MNSS_BEGIN_IND); mnss_begin_ind->ti = ss_data->ti; memcpy (mnss_begin_ind->fac_inf.fac, ss_register->ss_facility.fac_info, ss_register->ss_facility.c_fac_info); mnss_begin_ind->fac_inf.l_fac = ss_register->ss_facility.c_fac_info << 3; mnss_begin_ind->fac_inf.o_fac = 0; SET_SS_STATE(ss_data->ss_state,ss_data->ti,SS_CONNECTED); /*lint !e502 (Warning -- Warning 502: Expected unsigned type ) */ MM_EM_REGISTER_MESSAGE_RECEIVED; PSENDX (MMI, mnss_begin_ind); } else { /* REGISTER with set TI flag received. Release the connection */ PALLOC (mmss_release_req, MMSS_RELEASE_REQ); /* T_MMSS_RELEASE_REQ */ mmss_release_req->ti = ss_data->ti; PSENDX (MM, mmss_release_req); } break; default: /* Should never reach here */ TRACE_FUNCTION("**BAD SS State**"); break; } } /* * ------------------------------------------------------------------- * Procedures * ------------------------------------------------------------------- */ /* +--------------------------------------------------------------------+ | PROJECT : GSM-PS (6147) MODULE : SS_SS | | STATE : code ROUTINE : ss_init | +--------------------------------------------------------------------+ PURPOSE : */ GLOBAL void ss_init (void) { GET_INSTANCE_DATA; memset (ss_data, 0, sizeof (T_SS_DATA)); } /* +--------------------------------------------------------------------+ | PROJECT : GSM-PS (6147) MODULE : SS_SS | | STATE : code ROUTINE : send_rel_comp | +--------------------------------------------------------------------+ PURPOSE : This functions sends a RELEASE COMPLETE message with a specified 'cause' value */ GLOBAL void send_rel_comp(U8 cause) { GET_INSTANCE_DATA; TRACE_FUNCTION ("send_rel_comp()"); { MCAST (ss_rel_comp, B_SS_REL_COMP); ss_rel_comp->msg_type = B_SS_REL_COMP; ss_rel_comp->v_ss_facility = FALSE; ss_rel_comp->v_ss_cause = TRUE; ss_rel_comp->ss_cause.v_cs2 = TRUE; ss_rel_comp->ss_cause.cs2 = CS_GSM_PLMN; ss_rel_comp->ss_cause.v_loc = TRUE; ss_rel_comp->ss_cause.loc = LOC_PUB_NET_REMOTE_USER; ss_rel_comp->ss_cause.v_rec = TRUE; ss_rel_comp->ss_cause.rec = 0x00; ss_rel_comp->ss_cause.v_cs = TRUE; ss_rel_comp->ss_cause.cs = cause; ss_rel_comp->ss_cause.c_diag = 0x00; ss_for_data_req(LEN_U_SS_RELEASE_COMPLETE); } { PALLOC (mmss_release_req, MMSS_RELEASE_REQ); mmss_release_req->ti = ss_data->ti; PSENDX (MM, mmss_release_req); } SET_SS_STATE(ss_data->ss_state,ss_data->ti,SS_IDLE); /*lint !e502 (Warning -- Warning 502: Expected unsigned type ) */ } /* +--------------------------------------------------------------------+ | | STATE : code ROUTINE : ss_check_critical_error | +--------------------------------------------------------------------+ PURPOSE : This function checks wheter a critical error has been detected in the air message. Critical errors which prevent the treatment of an air message are - invalid Message ID - mandatory IE missing - IE coded as comprehension required missing */ GLOBAL BOOL ss_check_critical_error (UINT ss_err) { TRACE_FUNCTION ("cc_check_critical_error ()"); if (ss_err EQ CAUSE_INVALID_MAND_INFO OR ss_err EQ CAUSE_MESSAGE_TYPE_NOT_IMPLEM OR ss_err EQ ERR_INVALID_MID OR ss_err EQ CAUSE_SERVICE_NOT_IMPLEM ) return (TRUE); else return (FALSE); } #endif /* #ifndef SS_SS_C */