FreeCalypso > hg > fc-magnetite
view src/g23m-aci/aci/psa_psip.c @ 653:094152d97ce7
Luna bring-up: workaround for slow LCD init sequence
author | Mychaela Falconia <falcon@freecalypso.org> |
---|---|
date | Thu, 07 May 2020 20:08:01 +0000 |
parents | 53929b40109c |
children |
line wrap: on
line source
/* +----------------------------------------------------------------------------- | Project : GSM-PS (6147) | Modul : PSA_PSIP +----------------------------------------------------------------------------- | 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 module defines the processing functions for the | primitives sent to the protocol stack adapter by the DTI | interface. +----------------------------------------------------------------------------- */ #if defined (FF_PSI) && defined (DTI) #define PSA_PSIP_C #include "aci_all.h" /*==== INCLUDES ===================================================*/ #include "aci_cmh.h" #include "ati_cmd.h" #include "dti.h" /* functionality of the dti library */ #include "aci.h" #include "aci_lst.h" #include "dti_conn_mng.h" #include "dti_cntrl_mng.h" #include "psa_psi.h" #include "cmh_psi.h" #include "ati_src_psi.h" #include "ati_io.h" #include "aci_mem.h" #include "sap_dti.h" /*==== CONSTANTS ==================================================*/ /*==== TYPES ======================================================*/ GLOBAL T_ACI_LIST *psi_dev_list=NULL; /*==== EXPORT =====================================================*/ /*==== VARIABLES ==================================================*/ /*==== FUNCTIONS ==================================================*/ /* for tracing of establishing of CMD channels for dual port version */ /* +----------------------------------------------------------------------+ | PROJECT : GPRS (8441) MODULE : PSA_PSIP | | STATE : finished ROUTINE : find_psi_dev_no | +----------------------------------------------------------------------+ PURPOSE : search psi device number in psi device list */ LOCAL BOOL find_psi_dev_id ( U32 devId, void * elem ) { T_ACI_PSI *compared = (T_ACI_PSI *)elem; if (compared NEQ NULL) { if (compared->devId EQ devId ) { return TRUE; } else { return FALSE; } } else { return FALSE; } } #ifdef _SIMULATION_ /* +----------------------------------------------------------------------+ | PROJECT : GPRS (8441) MODULE : PSA_PSIP | | STATE : finished ROUTINE : mng_psi_dev_list_test | +----------------------------------------------------------------------+ PURPOSE : manage psi device list */ LOCAL BOOL mng_psi_dev_list_test ( T_PSI_CONN_IND_TEST *psi_conn_ind_test ) { T_ACI_PSI *msg_ptr = NULL; if(psi_dev_list EQ NULL) {/* there is no psi device list */ psi_dev_list = new_list(); } msg_ptr = psi_find_element(psi_dev_list, psi_conn_ind_test->devId, find_psi_dev_id); if(msg_ptr EQ NULL) {/* added new device */ { ACI_MALLOC(msg_ptr,sizeof(T_ACI_PSI)); msg_ptr->devId = psi_conn_ind_test->devId; msg_ptr->psi_data_mode = psi_conn_ind_test->psi_data_mode; switch (psi_conn_ind_test->devId & DIO_TYPE_DAT_MASK) { case DIO_DATA_SER: memcpy(&msg_ptr->psi_cap.dio_cap_ser,&psi_conn_ind_test->DIO_CAP_UN.DIO_CAP_SER, sizeof(msg_ptr->psi_cap.dio_cap_ser)); break; case DIO_DATA_MUX: memcpy(&msg_ptr->psi_cap.dio_cap_ser_mux, &psi_conn_ind_test->DIO_CAP_UN.DIO_CAP_SER_MUX, sizeof(msg_ptr->psi_cap.dio_cap_ser_mux)); break; case DIO_DATA_PKT: memcpy(&msg_ptr->psi_cap.dio_cap_pkt, &psi_conn_ind_test->DIO_CAP_UN.DIO_CAP_PKT, sizeof(msg_ptr->psi_cap.dio_cap_pkt)); break; } insert_list(psi_dev_list,msg_ptr); return (TRUE); } } else {/* new DIO capabilities for existing device */ return (FALSE); } } #endif /* _SIMULATION_ */ /* +----------------------------------------------------------------------+ | PROJECT : GPRS (8441) MODULE : PSA_PSIP | | STATE : finished ROUTINE : mng_psi_dev_list | +----------------------------------------------------------------------+ PURPOSE : manage psi device list */ LOCAL BOOL mng_psi_dev_list ( T_PSI_CONN_IND *psi_conn_ind ) { T_ACI_PSI *msg_ptr = NULL; if(psi_dev_list EQ NULL) {/* there is no psi device list */ psi_dev_list = new_list(); } msg_ptr = psi_find_element(psi_dev_list, psi_conn_ind->devId, find_psi_dev_id); if(msg_ptr EQ NULL) { /* added new device */ /* if((psi_conn_ind->dio_cap->data_mode >= DTI_CPBLTY_CMD ) AND (psi_conn_ind->dio_cap->data_mode <=(DTI_CPBLTY_CMD|DTI_CPBLTY_PKT|DTI_CPBLTY_SER)))*/ { ACI_MALLOC(msg_ptr,sizeof(T_ACI_PSI)); msg_ptr->devId = psi_conn_ind->devId; msg_ptr->psi_data_mode = psi_conn_ind->psi_data_mode; switch (psi_conn_ind->devId & DIO_TYPE_DAT_MASK) { case DIO_DATA_SER: if(psi_conn_ind->ptr_DIO_CAP NEQ NULL) { memcpy(&msg_ptr->psi_cap.dio_cap_ser,(T_DIO_CAP_SER *)&(psi_conn_ind->ptr_DIO_CAP), sizeof(msg_ptr->psi_cap.dio_cap_ser)); } break; case DIO_DATA_MUX: if(psi_conn_ind->ptr_DIO_CAP NEQ NULL) { memcpy(&msg_ptr->psi_cap.dio_cap_ser_mux, (T_DIO_CAP_SER_MUX *)&(psi_conn_ind->ptr_DIO_CAP), sizeof(msg_ptr->psi_cap.dio_cap_ser_mux)); } break; case DIO_DATA_PKT: if(psi_conn_ind->ptr_DIO_CAP NEQ NULL) { memcpy(&msg_ptr->psi_cap.dio_cap_pkt, (T_DIO_CAP_PKT *)&(psi_conn_ind->ptr_DIO_CAP), sizeof(msg_ptr->psi_cap.dio_cap_pkt)); } break; } insert_list(psi_dev_list,msg_ptr); return (TRUE); } /* else { neither CMD, SER nor PKT mode return (FALSE); }*/ } else {/* new DIO capabilities for existing device */ return (FALSE); } } /* +--------------------------------------------------------------------+ | PROJECT : GPRS (8441) MODULE : PSA_PSIP | | STATE : code ROUTINE : PSI_erase_dev_elem | +--------------------------------------------------------------------+ PURPOSE : erase an entry element from the psi_dev_list list. */ LOCAL void PSI_erase_dev_elem(U32 devId) { T_ACI_DTI_PRC_PSI *content; content = psi_remove_element (psi_dev_list, devId, find_psi_dev_id); ACI_MFREE (content); } #ifdef _SIMULATION_ /* +----------------------------------------------------------------------+ | PROJECT : GPRS (8441) MODULE : PSA_PSI | | STATE : finished ROUTINE : psa_psi_conn_ind_test | +----------------------------------------------------------------------+ PURPOSE : processes the PSI_CONN_IND_TEST primitive send by PSI. add new device to psi device list, create the ATI source and register the DIO capabilities in ACI */ GLOBAL const void psa_psi_conn_ind_test ( T_PSI_CONN_IND_TEST *psi_conn_ind_test ) { T_ACI_PSI * msg_ptr; UBYTE src_id = 0; U32 dio_cap; TRACE_FUNCTION ("psa_psi_conn_ind_test()"); dio_cap =psi_conn_ind_test->devId & DIO_TYPE_DAT_MASK; if(mng_psi_dev_list_test(psi_conn_ind_test) EQ TRUE ) { msg_ptr = psi_find_element(psi_dev_list, psi_conn_ind_test->devId, find_psi_dev_id); switch (dio_cap) { case DIO_DATA_SER: /*lint -fallthrough*/ case DIO_DATA_MUX: /*lint -fallthrough*/ case DIO_DATA_PKT: /* Create a new AT source if driver supports AT commands */ if(psi_conn_ind_test->psi_data_mode EQ DRIVER_MODE_AT OR psi_conn_ind_test->psi_data_mode EQ DRIVER_MODE_AT_DATA) { src_id = psi_new_source(psi_conn_ind_test->devId, NOT_PRESENT_8BIT, dio_cap); } cmhPSI_Ind(msg_ptr, src_id,dio_cap); break; default: break; } } else {/* second PSI_CONNECT_IND from same device or wrong convergence (mode) in DIO capabilities */ psaPSI_ConnRej(psi_conn_ind_test->devId); } /* free the primitive buffer */ PFREE (psi_conn_ind_test); } #endif /* _SIMULATION_ */ /* +----------------------------------------------------------------------+ | PROJECT : GPRS (8441) MODULE : PSA_PSI | | STATE : finished ROUTINE : psa_psi_conn_ind | +----------------------------------------------------------------------+ PURPOSE : processes the PSI_CONN_IND primitive send by PSI. add new device to psi device list, create the ATI source and register the DIO capabilities in ACI */ GLOBAL void psa_psi_conn_ind ( T_PSI_CONN_IND *psi_conn_ind ) { T_ACI_PSI * msg_ptr; UBYTE src_id = 0; U32 dio_cap; TRACE_FUNCTION ("psa_psi_conn_ind()"); /* cmhPSI_SetDcbParToUnchanged( device_entry );*/ dio_cap =psi_conn_ind->devId & DIO_TYPE_DAT_MASK; if(mng_psi_dev_list(psi_conn_ind) EQ TRUE ) { msg_ptr = psi_find_element(psi_dev_list, psi_conn_ind->devId, find_psi_dev_id); switch (dio_cap) { case DIO_DATA_SER: /*lint -fallthrough*/ case DIO_DATA_MUX: /*lint -fallthrough*/ case DIO_DATA_PKT: /* Create a new AT source if driver supports AT commands */ if(psi_conn_ind->psi_data_mode EQ DRIVER_MODE_AT OR psi_conn_ind->psi_data_mode EQ DRIVER_MODE_AT_DATA) { src_id = psi_new_source(psi_conn_ind->devId, NOT_PRESENT_8BIT, dio_cap); } cmhPSI_Ind(msg_ptr, src_id,dio_cap); break; default: break; } } else {/* second PSI_CONNECT_IND from same device or wrong convergence (mode) in DIO capabilities */ psaPSI_ConnRej(psi_conn_ind->devId); } /* free the primitive buffer */ PFREE (psi_conn_ind); } /* +----------------------------------------------------------------------+ | PROJECT : GPRS (8441) MODULE : PSA_PSI | | STATE : finished ROUTINE : psa_psi_dti_close_ind | +----------------------------------------------------------------------+ PURPOSE : processes the PSI_DTI_CLOSE_IND primitive send by PSI. this indicates the dti disconnection caused by the DIO driver */ GLOBAL void psa_psi_dti_close_ind( T_PSI_DTI_CLOSE_IND *psi_dti_close_ind ) { T_ACI_PSI * msg_ptr; TRACE_FUNCTION ("psa_psi_dti_close_ind()"); msg_ptr = psi_find_element(psi_dev_list, psi_dti_close_ind->devId, find_psi_dev_id); /* if the device_no does not exist in the psi_dev_list the primitive is ignored */ if(msg_ptr NEQ NULL) { cmhPSI_DTI_Close(psi_dti_close_ind->devId, PSI_DTI_CLS_IND, psi_dti_close_ind->link_id); } else { TRACE_EVENT ("ERROR: DEVICE NOT FOUND."); } /* free the primitive buffer */ PFREE (psi_dti_close_ind); } /* +----------------------------------------------------------------------+ | PROJECT : GPRS (8441) MODULE : PSA_PSI | | STATE : finished ROUTINE : psa_psi_disconn_ind | +----------------------------------------------------------------------+ PURPOSE : processes the PSI_DISCONN_IND primitive send by PSI. this indicates the disconnection of data call caused by the DIO driver */ GLOBAL void psa_psi_disconn_ind ( T_PSI_DISCONN_IND *psi_disconn_ind ) { T_ACI_PSI * msg_ptr; T_ACI_DTI_PRC_PSI *cmd; TRACE_FUNCTION ("psa_psi_disconn_ind()"); msg_ptr = psi_find_element(psi_dev_list, psi_disconn_ind->devId, find_psi_dev_id); cmd = cmhPSI_find_dlci (psi_src_params, psi_disconn_ind->devId, UART_DLCI_NOT_MULTIPLEXED); /* if the device_no does not exist in the psi_dev_list the primitive is ignored */ if(msg_ptr NEQ NULL) { /*erase the source*/ psi_erase_source( cmd->srcId ); /*erase the src element in the <psi_src_params>*/ cmhPSI_erase_src_elem (cmd->srcId ); /*erase the devie from the device list*/ PSI_erase_dev_elem (psi_disconn_ind->devId); } /* free the primitive buffer */ PFREE (psi_disconn_ind); } /* +----------------------------------------------------------------------+ | PROJECT : GPRS (8441) MODULE : PSA_PSI | | STATE : finished ROUTINE : psa_psi_dti_close_cnf | +----------------------------------------------------------------------+ PURPOSE : processes the PSI_DTI_CLOSE_CNF primitive sent by PSI. this confirms the dti disconnection requested by PSI_DTI_CLOSE_REQ */ GLOBAL void psa_psi_dti_close_cnf ( T_PSI_DTI_CLOSE_CNF *psi_dti_close_cnf ) { T_ACI_PSI * msg_ptr; TRACE_FUNCTION ("psa_psi_dti_close_cnf()"); msg_ptr = psi_find_element(psi_dev_list, psi_dti_close_cnf->devId, find_psi_dev_id); /* if the devId does not exist in the psi_dev_list the primitive is ignored */ if(msg_ptr NEQ NULL) { cmhPSI_DTI_Close(psi_dti_close_cnf->devId, PSI_DTI_CLS_CNF, psi_dti_close_cnf->link_id); } /* psaPSI_CloseReq(psi_dti_close_cnf->devId);*/ /* free the primitive buffer */ PFREE (psi_dti_close_cnf); } /* +----------------------------------------------------------------------+ | PROJECT : GPRS (8441) MODULE : PSA_PSI | | STATE : finished ROUTINE : psa_psi_close_cnf | +----------------------------------------------------------------------+ PURPOSE : processes the PSI_CLOSE_CNF primitive sent by PSI. this confirms the dti disconnection requested by PSI_CLOSE_REQ */ GLOBAL void psa_psi_close_cnf ( T_PSI_CLOSE_CNF *psi_close_cnf ) { T_ACI_PSI * msg_ptr; T_ACI_DTI_PRC_PSI *cmd; TRACE_FUNCTION ("psa_psi_close_cnf()"); msg_ptr = psi_find_element(psi_dev_list, psi_close_cnf->devId, find_psi_dev_id); cmd = cmhPSI_find_dlci (psi_src_params, psi_close_cnf->devId, UART_DLCI_NOT_MULTIPLEXED); /* if the devId does not exist in the psi_dev_list the primitive is ignored */ if(msg_ptr NEQ NULL) { /*erase the source*/ psi_erase_source( cmd->srcId ); /*erase the src element in the <psi_src_params>*/ cmhPSI_erase_src_elem (cmd->srcId ); /*erase the devie from the device list*/ PSI_erase_dev_elem (psi_close_cnf->devId); } /* free the primitive buffer */ PFREE (psi_close_cnf); } /* +----------------------------------------------------------------------+ | PROJECT : GPRS (8441) MODULE : PSA_PSI | | STATE : finished ROUTINE : psa_psi_dti_open_cnf | +----------------------------------------------------------------------+ PURPOSE : processes the PSI_DTI_OPEN_CNF primitive send by PSI. this confirms the dti connection requested by PSI_DTI_OPEN_REQ */ GLOBAL void psa_psi_dti_open_cnf ( T_PSI_DTI_OPEN_CNF *psi_dti_open_cnf ) { T_ACI_PSI * msg_ptr; TRACE_FUNCTION ("psa_psi_dti_open_cnf()"); msg_ptr = psi_find_element(psi_dev_list, psi_dti_open_cnf->devId, find_psi_dev_id); /* if the devId does not exist in the psi_dev_list the primitive is ignored */ if(msg_ptr NEQ NULL) { switch(psi_dti_open_cnf->cause) { case PSICS_SUCCESS: cmhPSI_DTI_OpenCnf(psi_dti_open_cnf->devId, psi_dti_open_cnf->link_id, DTI_OK); break; case PSICS_INVALID_PARAMS: case PSICS_DISCONNECT: case PSICS_INTERNAL_DRV_ERROR: default: cmhPSI_DTI_OpenCnf(psi_dti_open_cnf->devId, psi_dti_open_cnf->link_id, DTI_ERROR); break; } } /* free the primitive buffer */ PFREE (psi_dti_open_cnf); } /* +----------------------------------------------------------------------+ | PROJECT : GPRS (8441) MODULE : PSA_PSI | | STATE : finished ROUTINE : psa_psi_setconf_cnf | +----------------------------------------------------------------------+ PURPOSE : processes the PSI_DTI_SETCONF_CNF primitive send by PSI. this confirms the changed driver configuration requested by PSI_SETCONF_REQ */ GLOBAL void psa_psi_setconf_cnf (T_PSI_SETCONF_CNF *psi_setconf_cnf) { TRACE_FUNCTION ("psa_psi_setconf_cnf()"); /* free the primitive buffer */ PFREE (psi_setconf_cnf); } /* +---------------------------------------------------------------------+ | PROJECT : GSM-PS (6147) MODULE :PSA_PSIP | | ROUTINE : psa_psi_line_state_cnf | +---------------------------------------------------------------------+ PURPOSE : */ GLOBAL void psa_psi_line_state_cnf(T_PSI_LINE_STATE_CNF *psi_line_state_cnf) { T_ACI_DTI_PRC_PSI *src_infos = NULL; TRACE_FUNCTION("psa_psi_line_state_cnf ()"); src_infos = cmhPSI_find_dlci (psi_src_params, psi_line_state_cnf->devId, UART_DLCI_NOT_MULTIPLEXED); if (src_infos EQ NULL) { TRACE_EVENT_P1 ("[ERR] psa_psi_line_state_cnf: not found: device=%d;",psi_line_state_cnf->devId); } else { BITFIELD_CLEAR (src_infos->data_cntr, PSI_RING_RUNNING); } PFREE(psi_line_state_cnf); } /* +---------------------------------------------------------------------+ | PROJECT : GSM-PS (6147) MODULE : PSA_PSIP | | ROUTINE : psa_psi_line_state_ind | +---------------------------------------------------------------------+ PURPOSE : */ GLOBAL void psa_psi_line_state_ind(T_PSI_LINE_STATE_IND *psi_line_state_ind ) { TRACE_FUNCTION("psa_psi_line_state_ind()"); cmhPSI_Line_State_Ind ( psi_line_state_ind->devId, psi_line_state_ind->line_state ); PFREE(psi_line_state_ind); } #endif /*FF_PSI*/ /*==== EOF =======================================================*/