FreeCalypso > hg > fc-magnetite
view src/g23m-aci/aci/ati_src_psi_io.c @ 324:6ab14029931c
FCHG: default battery table implemented
author | Mychaela Falconia <falcon@freecalypso.org> |
---|---|
date | Tue, 05 Dec 2017 01:29:04 +0000 |
parents | 53929b40109c |
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 : +----------------------------------------------------------------------------- */ #ifdef FF_PSI #define ATI_SRC_PSI_IO_C #include "aci_all.h" /*==== INCLUDES ===================================================*/ #include "aci_cmh.h" #include "ati_cmd.h" #include "aci_cmd.h" #include "aci_lst.h" #include "dti.h" /* functionality of the dti library */ #include "dti_conn_mng.h" #include "psa_psi.h" #include "cmh_psi.h" #ifdef _SIMULATION_ #include "aci.h" #include "ati_src_tst.h" # ifdef SMI # undef hCommMMI # define hCommMMI hCommSMI # endif EXTERN T_ACI_LIST *ati_src_list; #endif #include "aci_io.h" #include "ati_io.h" #include "aci_mem.h" #include "ati_src_psi.h" #include "aci.h" #include "sap_dti.h" /*==== CONSTANTS ==================================================*/ #define MAX_NORMAL_BUFFER_LEN (100-4) // Since Malloc uses 4 additional internal bytes of the Blocks #ifdef GPRS #define MAX_LARGE_BUFFER_LEN (600-4) #else #define MAX_LARGE_BUFFER_LEN (400-4) #endif /*==== TYPES ======================================================*/ /*==== EXPORT =====================================================*/ /*==== VARIABLES ==================================================*/ /*==== FUNCTIONS ==================================================*/ LOCAL void io_DTIPSIsendString (UBYTE *string, USHORT string_len, T_ACI_DTI_PRC_PSI *src_infos, T_ATI_OUTPUT_TYPE output_type); #ifdef _SIMULATION_ LOCAL BOOL get_source_type( UBYTE src_id, T_ATI_SRC_TYPE *src_type ); #endif /*=================================================================*/ GLOBAL void psi_src_result_cb (UBYTE src_id, T_ATI_OUTPUT_TYPE output_type, UBYTE *output, USHORT output_len) { T_ACI_DTI_PRC_PSI *src_infos; TRACE_FUNCTION("psi_src_result_cb()"); src_infos = find_element (psi_src_params, (UBYTE)src_id, cmhPSItest_srcId); if (src_infos EQ NULL) { TRACE_EVENT_P1("[ERR] psi_src_result_cb: src_id=%d not found", src_id) ; return ; } switch (src_infos->LineState) { case LINE_CONNECTING: case LINE_CONNECTED: case LINE_TMP_CONNECTED: break; case LINE_TMP_DISCONNECTING: case LINE_TMP_DISCONNECTED: if (IS_FORCED_OUTPUT (output_type) || IS_CONFIRM_OUTPUT (output_type)) { break; } return; case LINE_DISCONNECTED: return; } if (src_infos->first_output EQ TRUE) { src_infos->first_output = FALSE; output_type |= ATI_BEGIN_CRLF_OUTPUT; } io_DTIPSIsendString (output, output_len, src_infos, output_type); } GLOBAL void psi_src_line_state_cb (UBYTE src_id, T_ATI_LINE_STATE_TYPE line_state_type, ULONG line_state_param) { T_ACI_DTI_PRC_PSI *src_infos; TRACE_FUNCTION("psi_src_line_state_cb()"); src_infos = find_element (psi_src_params, (UBYTE)src_id, cmhPSItest_srcId); if (src_infos EQ NULL) { TRACE_EVENT ("[ERR] psi_src_line_state_cb: src_id not found"); return; } switch (line_state_type) { case ATI_LINE_STATE_OUTPUT_TYPE: TRACE_EVENT_P1 ("output type: %d",line_state_param); src_infos->run_cmd = TRUE; src_infos->first_output = TRUE; if( line_state_param EQ ATI_OUTPUT_TYPE_LARGE ) { src_infos->large_type = TRUE; } else { src_infos->large_type = FALSE; } break; case ATI_LINE_STATE_DCD: if(line_state_param EQ IO_DCD_ON) { BITFIELD_SET (src_infos->data_cntr, PSI_DTI_SB_BIT); } else { BITFIELD_CLEAR (src_infos->data_cntr, PSI_DTI_SB_BIT); } psaPSI_DCDreq( src_id, (UBYTE)line_state_param ); break; case ATI_LINE_STATE_RNG: { T_IO_RING_PARAMS rng_params; memcpy (&rng_params, (T_IO_RING_PARAMS*)line_state_param, sizeof(T_IO_RING_PARAMS)); psaPSI_RINGreq( src_id, (UBYTE)rng_params.ring_stat ); break; } case ATI_LINE_STATE_START: break; case ATI_LINE_STATE_END: src_infos->run_cmd = FALSE; break; default: { TRACE_EVENT_P1("[WRN] psi_src_line_state_cb (): "\ "UNKNOWN line_state_type = %d", line_state_type); break; } } } LOCAL T_desc2 *get_last_buffer (T_desc2 *data_head) { T_desc2 *next_data; if (data_head EQ NULL) { return (NULL); } next_data = data_head; while ((T_desc2*)next_data->next NEQ NULL) { next_data = (T_desc2*)next_data->next; } return (next_data); } LOCAL T_desc2 *get_new_buffer (BOOL large_type, USHORT *max_buffer_size) { T_desc2 *new_buffer; if (large_type EQ TRUE) *max_buffer_size = MAX_LARGE_BUFFER_LEN; else *max_buffer_size = MAX_NORMAL_BUFFER_LEN; ACI_MALLOC (new_buffer, *max_buffer_size); *max_buffer_size -= (sizeof(T_desc2) - 1); new_buffer->next = (ULONG)NULL; new_buffer->len = 0; new_buffer->size = *max_buffer_size; new_buffer->offset = 0; return (new_buffer); } LOCAL void free_data_buffer (T_ACI_DTI_DATA_BUF *data_buffer) { T_desc2 *p_desc, *p_desc_next=NULL; if (data_buffer->data_list EQ NULL) { return; } p_desc = data_buffer->data_list; if (p_desc NEQ NULL) { p_desc_next = (T_desc2 *)p_desc->next; } while (p_desc NEQ NULL) { ACI_MFREE (p_desc); p_desc = p_desc_next; if (p_desc NEQ NULL) { p_desc_next = (T_desc2 *)p_desc->next; } } data_buffer->data_list = NULL; data_buffer->max_buffer_size = 0; data_buffer->create_time = 0; } GLOBAL void psi_buffer_data (T_ACI_DTI_PRC_PSI *src_infos, T_desc2 *send_data) { T_desc2 *active_buffer, *last_buffer; USHORT i, j; T_TIME current_time; TRACE_FUNCTION("psi_buffer_data()"); last_buffer = get_last_buffer(src_infos->data_buffer.data_list); active_buffer = last_buffer; if (last_buffer EQ NULL) { active_buffer = get_new_buffer (src_infos->large_type, &src_infos->data_buffer.max_buffer_size); src_infos->data_buffer.data_list = active_buffer; last_buffer = active_buffer; /* store the creation time for the data buffer */ vsi_t_time (VSI_CALLER &src_infos->data_buffer.create_time); } else { /* If no device is connected to PSI it is possible that the buffer use all available memory. Solution: When the line is connected, check the life time of the data buffer. Remove the buffer if the live time is greater than 30 sec. (only if line is in data mode (line is disconnected)). */ // if (src_infos->LineState EQ LINE_CONNECTED) // line is always connected { vsi_t_time (VSI_CALLER ¤t_time); if ((current_time - src_infos->data_buffer.create_time) > MAX_DATA_BUFFER_LIFE_TIME) { TRACE_EVENT_P1 ("[WRN] psi_buffer_data(): life time expired, buffer deleted (%d)", current_time - src_infos->data_buffer.create_time); free_data_buffer (&src_infos->data_buffer); return; } } } i = 0; while (i < send_data->len) { if (active_buffer->len EQ active_buffer->size) // (src_infos->data_buffer.max_buffer_size)) { active_buffer = get_new_buffer (src_infos->large_type, &src_infos->data_buffer.max_buffer_size); last_buffer->next = (ULONG)active_buffer; last_buffer = active_buffer; } // Optimize for Speed j = MINIMUM((active_buffer->size - active_buffer->len), (send_data->len - i)); if (j>1) { /*lint -e670 (Warning: Possible access beyond array for function)*/ memcpy((char *)&active_buffer->buffer[active_buffer->len], (char *)&send_data->buffer[i], j); active_buffer->len += j; i += j; } else active_buffer->buffer[active_buffer->len++] = send_data->buffer[i++]; } } GLOBAL void psi_send_buffer_data (UBYTE src_id) { T_ACI_DTI_PRC_PSI *src_infos = NULL; TRACE_FUNCTION("psi_send_buffer_data()"); /* dti_id should be supported by DTI_ENTITY_ID or something, here.. */ src_infos = find_element (psi_src_params, src_id, cmhPSItest_srcId); if (aci_src_dti_params[src_id].isDtiConnected EQ FALSE) { TRACE_EVENT ("DTI_READY_IND: line not connected"); return; } /* * send data which may have been stored .. */ if (src_infos->data_buffer.data_list NEQ NULL) { #ifdef _SIMULATION_ { T_ATI_SRC_TYPE src_type; if(get_source_type(src_infos->srcId, &src_type)) { if( ATI_SRC_TYPE_TST EQ src_type ) { ati_src_tst_sendString(src_infos->data_buffer.data_list, src_infos->srcId); } else { psa_psi_DTI_data_req (src_infos->data_buffer.data_list, src_infos, DTI_ENTITY_PSI); } } } #else psa_psi_DTI_data_req (src_infos->data_buffer.data_list, src_infos, DTI_ENTITY_PSI); #endif /* _SIMULATION_ */ src_infos->data_buffer.data_list = NULL; src_infos->data_buffer.max_buffer_size = 0; src_infos->data_buffer.create_time = 0; } } LOCAL T_desc2 *make_send_data (UBYTE *data, USHORT data_len, T_ATI_OUTPUT_TYPE output_type) { T_desc2 *send_data; USHORT send_len = 0; #if !defined (_SIMULATION_) OR defined(ACIDTI_TEST_SIM) static UBYTE formated_output[MAX_CMD_LEN+5]; USHORT formated_len; formated_len = format_output (data, data_len, formated_output, output_type); send_len = sizeof(T_desc2) - 1 + formated_len; ACI_MALLOC(send_data, send_len); send_data->next = (ULONG)NULL; send_data->len = formated_len; send_data->size = formated_len; send_data->offset = 0; memcpy(send_data->buffer, formated_output, formated_len); #else /* _SIMULATION_ */ send_len = sizeof(T_desc2) - 1 + data_len; ACI_MALLOC(send_data, send_len); send_data->next = (ULONG)NULL; send_data->len = data_len; send_data->size = data_len; send_data->offset = 0; memcpy(send_data->buffer, data, data_len); #endif /* _SIMULATION_ */ return (send_data); } /* +-------------------------------------------------------------------+ | PROJECT : GSM-PS (6147) MODULE : CMH_DTIS | | ROUTINE : io_DTIPSIsendString | +-------------------------------------------------------------------+ PURPOSE : format output string and send to the PSI through DTI */ LOCAL void io_DTIPSIsendString (UBYTE *string, USHORT string_len, T_ACI_DTI_PRC_PSI *src_infos, T_ATI_OUTPUT_TYPE output_type) { T_desc2 *send_data; #ifdef _SIMULATION_ T_ATI_SRC_TYPE src_type; /* * get_source_type() writes an trace_event in the error case. */ if(!get_source_type(src_infos->srcId, &src_type)) return; #endif /* _SIMULATION_ */ TRACE_FUNCTION("io_DTIPSIsendString"); if (!IS_ECHO_OUTPUT (output_type)) { #ifdef _SIMULATION_ if( ATI_SRC_TYPE_TST NEQ src_type ) #endif /* _SIMULATION_ */ { trace_cmd_line ("OUT:", (CHAR*)string, src_infos->srcId, string_len); } } if (string_len > MAX_LARGE_BUFFER_LEN) { TRACE_ERROR ("String too large for io_DTIPSIsendString!"); TRACE_EVENT_P2 ("Truncating string from %d to %d", string_len, MAX_LARGE_BUFFER_LEN); string_len = MAX_LARGE_BUFFER_LEN; } send_data = make_send_data (string, string_len, output_type); if ((aci_src_dti_params[src_infos->srcId].isDtiConnected) AND (aci_src_dti_params[src_infos->srcId].dtxState EQ READY)) { #ifdef _SIMULATION_ if( ATI_SRC_TYPE_TST EQ src_type ) { ati_src_tst_sendString(send_data, src_infos->srcId); ACI_MFREE(send_data); } else { psa_psi_DTI_data_req (send_data, src_infos, DTI_ENTITY_PSI); } #else /* send message through DTI */ psa_psi_DTI_data_req (send_data, src_infos, DTI_ENTITY_PSI); #endif /* _SIMULATION_ */ } else { /* buffer these datas */ psi_buffer_data (src_infos, send_data); ACI_MFREE (send_data); } } #ifdef _SIMULATION_ /* +-------------------------------------------------------------------+ | PROJECT : GSM-PS (6147) MODULE : ATI_SRC_PSI_IO_C | | ROUTINE : get_source_type | +-------------------------------------------------------------------+ PURPOSE : provides the source type for a source ID returns FALSE if source ID is not registered */ LOCAL BOOL get_source_type( UBYTE src_id, T_ATI_SRC_TYPE *src_type ) { T_ATI_SRC_PARAMS *src_params = NULL; src_params = find_element (ati_src_list, src_id, search_ati_src_id); if (src_params EQ NULL) { TRACE_EVENT_P1("[ERR] get_source_type: source ID %d not found", src_id); *src_type = ATI_SRC_TYPE_UNKNOWN; return FALSE; } *src_type = src_params->src_type; return TRUE; } /* +--------------------------------------------------------------------+ | PROJECT : GSM-PS (6147) MODULE : ATI_SRC_PSI_IO_C | | ROUTINE : psi_src_test_sendString | +--------------------------------------------------------------------+ PURPOSE : Provides the io_DTIsendString() for the test-source-callback and apends a separator to the message. The separator is needed to isolates the messages in the case of buffering messages during PSI is not connected with ACI */ GLOBAL void psi_src_test_sendString (UBYTE *string, USHORT string_len, T_ACI_DTI_PRC_PSI *src_infos, T_ATI_OUTPUT_TYPE output_type) { UBYTE *tmp; ACI_MALLOC(tmp, string_len + 1); strncpy(tmp, string, string_len); tmp[string_len] = (UBYTE) ATI_TEST_SRC_SEPARATOR; io_DTIPSIsendString(tmp, (USHORT) (string_len + 1), src_infos, output_type); ACI_MFREE(tmp); } #endif /*_SIMULATION_*/ #endif /*FF_PSI*/ /*==== EOF =======================================================*/