freecalypso-sw: gsm-fw/services/etm/etm

annotate gsm-fw/services/etm/etm_task.c @ 865:f5affe83ba2d

lldbg hack (poor girl's substitute for JTAG) implemented

author	Space Falcon <falcon@ivan.Harhan.ORG>
date	Fri, 15 May 2015 00:02:03 +0000
parents	13af69b6a3dc
children

rev	line source
164 d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1 /********************************************************************************
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2 * Enhanced TestMode (ETM)
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	3 * @file etm.c
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	4 *
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	5 * @author Kim T. Peteren (ktp@ti.com)
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	6 * @version 0.1
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	7 *
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	8
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	9
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	10 *
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	11 * History:
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	12 *
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	13 * Date Modification
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	14 * ------------------------------------
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	15 * 16/06/2003 Creation
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	16 * 03/03/2004 Upadted regarding the ATP + minor ETM DB handling updates
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	17 * 28/07/2004 Fixed ETM database issue
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	18 *
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	19 * (C) Copyright 2003 by Texas Instruments Incorporated, All Rights Reserved
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	20 *********************************************************************************/
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	21
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	22
166 13af69b6a3dc ETM core compiles Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: 164 diff changeset	23 #include "etm.h"
13af69b6a3dc ETM core compiles Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: 164 diff changeset	24 #include "etm_config.h"
13af69b6a3dc ETM core compiles Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: 164 diff changeset	25 #include "etm_api.h"
13af69b6a3dc ETM core compiles Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: 164 diff changeset	26 #include "etm_messages_i.h"
13af69b6a3dc ETM core compiles Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: 164 diff changeset	27 #include "etm_trace.h"
13af69b6a3dc ETM core compiles Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: 164 diff changeset	28 #include "etm_env.h"
164 d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	29
166 13af69b6a3dc ETM core compiles Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: 164 diff changeset	30 #if ETM_AUDIO_SUPPORT
164 d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	31 #include "audio/audio_api.h"
166 13af69b6a3dc ETM core compiles Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: 164 diff changeset	32 #endif
164 d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	33
166 13af69b6a3dc ETM core compiles Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: 164 diff changeset	34 #include "../../riviera/rv/rv_general.h"
13af69b6a3dc ETM core compiles Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: 164 diff changeset	35 #include "../../riviera/rvf/rvf_api.h"
13af69b6a3dc ETM core compiles Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: 164 diff changeset	36 #include "../../riviera/rvt/rvt_gen.h"
13af69b6a3dc ETM core compiles Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: 164 diff changeset	37 #include "../../riviera/rvf/rvf_target.h"
13af69b6a3dc ETM core compiles Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: 164 diff changeset	38 #include "../../riviera/rv/rv_defined_swe.h"
164 d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	39
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	40 #include <string.h>
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	41
166 13af69b6a3dc ETM core compiles Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: 164 diff changeset	42 #if ETM_LCC_SUPPORT
164 d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	43 #include "lcc/lcc_api.h"
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	44 #include "lcc/lcc_cfg_i.h"
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	45 #include "lcc/lcc.h"
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	46 #include "lcc/lcc_env.h"
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	47 #include "lcc/lcc_trace.h"
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	48 #endif
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	49
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	50 // Version of the ETM TASK moved to etm_version.h
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	51 //const uint16 etm_task_revision = (1<<12) \| (0x1);
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	52
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	53 /******************************************************************************
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	54 * Globals
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	55 *****************************************************************************/
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	56
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	57 #define ETM_DB_MAX 16 // Limited of registered SWEntities into ETM DB
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	58 #define ETM_DB_NO_USE 0xFFFFFFFF //
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	59
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	60 typedef struct
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	61 {
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	62 char swe_name[ETM_NAME_MAX_LEN];
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	63 int mid;
166 13af69b6a3dc ETM core compiles Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: 164 diff changeset	64 int task_id;
164 d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	65 T_RVF_ADDR_ID addr_id; // Unique mailbox (ID) of the SWE which will
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	66 //receive the message
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	67 ETM_CALLBACK_FUNC rx_callback_func;
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	68 } T_ETM_USER_DB;
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	69
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	70
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	71 static T_ETM_USER_DB etm_user_db[ETM_DB_MAX];
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	72
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	73 static int etm_db_counter = 0;
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	74
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	75
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	76 /******************************************************************************
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	77 * Prototypes
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	78 *****************************************************************************/
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	79
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	80 extern T_ETM_ENV_CTRL_BLK *etm_env_ctrl_blk;
166 13af69b6a3dc ETM core compiles Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: 164 diff changeset	81 #if ETM_LCC_SUPPORT
164 d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	82 extern T_PWR_CTRL_BLOCK *pwr_ctrl;
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	83 #endif
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	84
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	85 int etm_database_manager(T_RV_HDR *msg_p);
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	86 int etm_forward_packet(int mid, T_RV_HDR *msg);
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	87 void etm_error_packet_send(int mid, int error);
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	88 void etm_receive(unsigned char *inbuf, unsigned short size);
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	89
166 13af69b6a3dc ETM core compiles Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: 164 diff changeset	90 #if ETM_ATP_SUPPORT
164 d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	91 extern int etm_at_atp_message(void *msg);
166 13af69b6a3dc ETM core compiles Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: 164 diff changeset	92 #endif
13af69b6a3dc ETM core compiles Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: 164 diff changeset	93
13af69b6a3dc ETM core compiles Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: 164 diff changeset	94 #if ETM_LCC_SUPPORT
164 d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	95 extern int etm_pwr_ul(void *msg);
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	96 extern int etm_pwr_dl(T_ETM_PKT pkt, uint8 buf, int insize);
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	97 #endif
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	98
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	99 /******************************************************************************
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	100 * Main Testmode Task Loop
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	101 *****************************************************************************/
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	102
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	103 T_RV_RET etm_task(void)
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	104 {
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	105 extern int etm_core_init(void);
166 13af69b6a3dc ETM core compiles Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: 164 diff changeset	106 #if ETM_AUDIO_SUPPORT
13af69b6a3dc ETM core compiles Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: 164 diff changeset	107 extern int etm_audio_init(void);
13af69b6a3dc ETM core compiles Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: 164 diff changeset	108 #endif
13af69b6a3dc ETM core compiles Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: 164 diff changeset	109 #if ETM_LCC_SUPPORT
13af69b6a3dc ETM core compiles Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: 164 diff changeset	110 extern int etm_pwr_init(void);
13af69b6a3dc ETM core compiles Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: 164 diff changeset	111 #endif
164 d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	112
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	113 T_RV_HDR *msg = NULL;
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	114 T_ETM_PKT *pkt = NULL;
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	115 UINT32 start_time = 0;
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	116 UINT32 end_time = 0;
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	117 UINT16 recv_event, i;
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	118
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	119 int status = RV_OK, buf_size;
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	120
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	121 /* Entity registration to ETM */
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	122 /* This should be in the individual SWE init. function*/
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	123 status = etm_core_init();
166 13af69b6a3dc ETM core compiles Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: 164 diff changeset	124 #if ETM_AUDIO_SUPPORT
164 d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	125 status = etm_audio_init();
166 13af69b6a3dc ETM core compiles Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: 164 diff changeset	126 #endif
13af69b6a3dc ETM core compiles Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: 164 diff changeset	127 #if ETM_LCC_SUPPORT
164 d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	128 status = etm_pwr_init();
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	129 #endif
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	130
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	131 while (1)
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	132 {
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	133 recv_event = rvf_wait(0xffff,0); /* Wait (infinite) for all events. */
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	134
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	135 start_time = rvf_get_tick_count();
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	136 tr_etm(TgTrEtmLow,"ETM: _task: Time Waiting (%d) tick", start_time - end_time);
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	137 tr_etm(TgTrEtmLow,"ETM: _task: Time Start(%d)", start_time);
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	138
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	139 tr_etm(TgTrEtmLow,"ETM: _task: Got message passing to bit filter (0x%x)", recv_event);
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	140
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	141
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	142 if (!(recv_event & RVF_TASK_MBOX_0_EVT_MASK))
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	143 continue;
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	144
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	145 /* Read the message in the ETM mailbox */
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	146 if ((msg = rvf_read_mbox(ETM_MAILBOX)) == NULL)
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	147 continue;
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	148
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	149 tr_etm(TgTrEtmLow,"ETM: _task: msg_id(0x%x)", msg->msg_id);
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	150
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	151 switch (msg->msg_id) {
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	152 /* Entity registration request or unregistration */
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	153 case ETM_REGISTER_REQ:
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	154 case ETM_UNREGISTER:
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	155 status = etm_database_manager(msg);
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	156 break;
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	157 /* ETM packet received */
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	158 case ETM_DATA_FWR:
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	159 if ((status = etm_forward_packet(((T_ETM_DATA_FWR *) msg)->mid, msg))
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	160 != ETM_OK)
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	161 etm_error_packet_send(((T_ETM_DATA_FWR *) msg)->mid, status);
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	162 break;
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	163 /* TM3 packet received */
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	164 case ETM_TM3_DATA_FWR:
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	165 if ((status = etm_forward_packet(ETM_TM3, msg)) != ETM_OK)
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	166 etm_error_packet_send(ETM_TM3, status);
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	167 break;
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	168 default:
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	169 tr_etm(TgTrEtmLow,"ETM: _task: msg_id '0x%x' NOT supported",
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	170 msg->msg_id);
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	171 }
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	172
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	173 if (status != ETM_OK) {
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	174 tr_etm(TgTrFatal,"ETM: _task: mid(0x%x) ERROR(%d)",
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	175 ((T_ETM_DATA_FWR *) msg)->mid, status);
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	176 etm_free(msg); // Free the message
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	177 }
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	178
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	179 end_time = rvf_get_tick_count();
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	180 tr_etm(TgTrEtmLow,"ETM: _task: Time End (%d)", end_time);
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	181 tr_etm(TgTrEtmLow,"ETM: _task: Time Total (%d) tick", end_time - start_time);
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	182 }
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	183
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	184 return RV_OK;
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	185 }
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	186
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	187
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	188 void etm_error_packet_send(int mid, int error)
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	189 {
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	190 T_ETM_PKT *pkt;
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	191
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	192 tr_etm(TgTrFatal,"ETM: _error_packet_send: Module(0x%x) ERROR(%d)", mid, error);
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	193
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	194 if (error == ETM_NOMEM) {
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	195 rvf_dump_mem();
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	196 }
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	197
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	198 if ((pkt = (T_ETM_PKT *) etm_malloc(sizeof(T_ETM_PKT))) == NULL) {
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	199 rvf_dump_mem();
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	200 return;
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	201 }
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	202
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	203 // Init. of return packet
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	204 pkt->mid = mid;
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	205 pkt->status = -error;
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	206 pkt->size = 0;
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	207 pkt->index = 0;
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	208
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	209 etm_pkt_send(pkt);
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	210 etm_free(pkt); // Free return packet
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	211 }
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	212
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	213
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	214 /* Forwarding of DATA to the SWE can either be done by message/primitive or callback */
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	215 int etm_forward_packet(int mid, T_RV_HDR* msg)
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	216 {
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	217 ETM_CALLBACK_FUNC rx_callback_func = NULL;
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	218 int i, cid, status = ETM_OK;
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	219 T_ETM_DATA_READY* message_p;
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	220 T_RVF_ADDR_ID swe_addr_id = 0;
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	221
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	222 // Search for supported MID in the table
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	223 for (i = 0; etm_user_db[i].mid != TABLE_END; i++)
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	224 {
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	225 tr_etm(TgTrEtmLow,"ETM: _forward_packet: Lookup in db for mid(0x%x)", mid);
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	226
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	227 if (etm_user_db[i].mid == mid) {
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	228 rx_callback_func = etm_user_db[i].rx_callback_func;
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	229 swe_addr_id = etm_user_db[i].addr_id;
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	230 break;
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	231 }
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	232 }
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	233
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	234 tr_etm(TgTrEtmLow,"ETM: _forward_packet: rx_callback_func(%d) swe_addr_id(%d)",
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	235 *rx_callback_func, swe_addr_id);
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	236
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	237 // Invoke the SWE mailbox
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	238 if (swe_addr_id) {
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	239 /* Allocate the memory for the message to send */
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	240 if ((message_p = (T_ETM_DATA_READY*) etm_malloc(sizeof(T_ETM_DATA_READY))) == NULL)
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	241 return ETM_NOMEM;
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	242
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	243 /* Fill the header of the message */
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	244 message_p->header.msg_id = ETM_DATA_READY;
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	245
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	246 /* Fill the address source id */
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	247 message_p->header.src_addr_id = rvf_get_taskid();
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	248 message_p->header.dest_addr_id = etm_env_ctrl_blk->addr_id;
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	249 message_p->header.callback_func = NULL;
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	250
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	251 /* Fill the data in the message */
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	252 memcpy(((T_ETM_DATA_READY) message_p)->data, ((T_ETM_DATA_FWR) msg)->data,
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	253 ((T_ETM_DATA_FWR*) msg)->size);
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	254
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	255 /* Send the message to the entity */
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	256 if ((status = rvf_send_msg(swe_addr_id, message_p)) != RV_OK) {
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	257 tr_etm(TgTrFatal,"ETM: _forward_packet: Failed to sent message - ERROR(%d)",
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	258 status);
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	259 return ETM_RV_FATAL;
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	260 }
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	261 etm_free(msg); // Free the message
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	262 }
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	263 // Invoke the SWE callback function
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	264 else if (rx_callback_func) {
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	265 tr_etm(TgTrEtmLow,"ETM: _forward_packet: to mid(0x%x)", mid);
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	266 status = rx_callback_func (((T_ETM_DATA_FWR) msg)->data, ((T_ETM_DATA_FWR) msg)->size);
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	267 rx_callback_func = NULL;
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	268 if (status != ETM_OK)
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	269 return status;
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	270 etm_free(msg); // Free the message
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	271 }
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	272 else {
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	273 return ETM_NOSYS;
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	274 }
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	275
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	276 return ETM_OK;
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	277 }
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	278
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	279
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	280 /******************************************************************************
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	281 * Get and Free buffer (Internal Functions)
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	282 *****************************************************************************/
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	283
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	284 void *etm_malloc(int size)
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	285 {
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	286 /* Memory bank status (red, yellow, green) */
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	287 T_RVF_MB_STATUS mb_status;
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	288 void *addr;
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	289
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	290 mb_status = rvf_get_buf(etm_env_ctrl_blk->prim_id, size, &addr);
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	291
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	292 /* The flag returned by rvf_get_buf is red, there is not enough
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	293 * memory to allocate the buffer. */
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	294 if (mb_status == RVF_RED) {
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	295 tr_etm(TgTrFatal, "ETM: _malloc: Error to get memory");
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	296 return NULL;
166 13af69b6a3dc ETM core compiles Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: 164 diff changeset	297 }
164 d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	298 /* The flag is yellow, there will soon be not enough memory anymore. */
166 13af69b6a3dc ETM core compiles Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: 164 diff changeset	299 else if (mb_status == RVF_YELLOW) {
13af69b6a3dc ETM core compiles Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: 164 diff changeset	300 tr_etm(TgTrFatal, "ETM: _malloc: Getting short on memory");
13af69b6a3dc ETM core compiles Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: 164 diff changeset	301 }
164 d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	302
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	303 tr_etm(TgTrEtmLow,"ETM: _malloc: size(%d) at addr(0x%x)", size, addr);
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	304 return addr;
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	305 }
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	306
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	307 int etm_free(void *addr)
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	308 {
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	309 int status;
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	310
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	311 tr_etm(TgTrEtmLow,"ETM: _free: addr(0x%x)", addr);
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	312
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	313 if ((status = rvf_free_buf(addr)) != RV_OK) {
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	314 tr_etm(TgTrFatal, "ETM: _free: ERROR(%d)", status);
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	315 }
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	316
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	317 return ETM_RV_FATAL;
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	318 }
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	319
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	320
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	321 /******************************************************************************
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	322 * ETM receive Functions API (Internal Functions)
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	323 ******************************************************************************/
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	324
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	325 /* The input pointer buf point at a complete TM3 packet. */
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	326 int etm_tm3_data_forward(uint8 *buf, int size)
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	327 {
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	328 /* Type for a registration event. */
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	329 T_ETM_TM3_DATA_FWR *msg;
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	330
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	331 tr_etm(TgTrEtmLow, "ETM: _tm3_data_forward: cid(0x%x) size(%d)", *buf, size);
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	332
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	333 /* Allocate the memory for the message to send */
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	334 if ((msg = (T_ETM_TM3_DATA_FWR*) etm_malloc(sizeof(T_ETM_TM3_DATA_FWR))) == NULL)
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	335 return ETM_NOMEM;
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	336
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	337 /* Fill the message id */
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	338 msg->header.msg_id = ETM_TM3_DATA_FWR;
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	339
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	340 /* Fill the address source id */
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	341 msg->header.src_addr_id = rvf_get_taskid();
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	342 msg->header.dest_addr_id = etm_env_ctrl_blk->addr_id;
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	343 msg->header.callback_func = NULL;
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	344
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	345 /* Fill the message parameters */
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	346 msg->size = size;
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	347 msg->cid = *buf;
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	348 memcpy(&msg->data, buf, size);
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	349
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	350 // At this point, all the data have been parsed and copied into
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	351 // the ETM primitive. Now we send the primitive to the ETM task.
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	352 if (rvf_send_msg(etm_env_ctrl_blk->addr_id, msg) != RV_OK) {
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	353 tr_etm(TgTrFatal, "ETM: _tm3_data_forward: FAILED");
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	354 return ETM_RV_FATAL; // msg is auto freed by rvf_send_msg() if error
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	355 }
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	356
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	357 return ETM_OK;
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	358 }
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	359
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	360
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	361 /* The input pointer buf point at payload of the TM packet, minus mid and cksum. */
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	362 int etm_data_forward(char mid, uint8 *inbuf, int size)
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	363 {
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	364 /* Type for a registration event. */
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	365 T_ETM_DATA_FWR *msg;
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	366
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	367 tr_etm(TgTrEtmLow, "ETM: _data_forward: mid(0x%x) size(%d)", mid, size);
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	368
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	369 /* Allocate the memory for the message to send */
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	370 if ((msg = (T_ETM_DATA_FWR*) etm_malloc(sizeof(T_ETM_DATA_FWR))) == NULL)
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	371 return ETM_NOMEM;
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	372
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	373 /* Fill the message id */
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	374 msg->header.msg_id = ETM_DATA_FWR;
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	375
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	376 /* Fill the address source id */
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	377 msg->header.src_addr_id = rvf_get_taskid();
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	378 msg->header.dest_addr_id = etm_env_ctrl_blk->addr_id;
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	379 msg->header.callback_func = NULL;
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	380
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	381 /* Fill the message parameters */
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	382 msg->size = size;
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	383 msg->mid = mid;
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	384 memcpy(&msg->data, inbuf, size);
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	385
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	386 // At this point, all the data have been parsed and copied into
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	387 // the ETM primitive. Now we send the primitive to the ETM task.
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	388 if (rvf_send_msg(etm_env_ctrl_blk->addr_id, msg) != RV_OK) {
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	389 tr_etm(TgTrFatal, "ETM: _data_forward: FAILED");
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	390 return ETM_RV_FATAL; // msg is auto freed by rvf_send_msg() if error
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	391 }
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	392
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	393 return ETM_OK;
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	394 }
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	395
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	396
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	397 /* This function is registred in the RVT module as the TestMode receive function */
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	398 /* It's called every time a TestMode packet is received on the UART and the */
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	399 /* data is forwarded to the ETM Entity via a message/primitiv */
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	400 /* The function is a callback func. used by the RVT TASK -> UART RX. */
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	401
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	402 void etm_receive(uint8 *inbuf, unsigned short size)
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	403 {
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	404 int error = ETM_NOSYS, i, index;
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	405 char mid;
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	406 unsigned char cksum;
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	407 T_ETM_PKT *pkt;
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	408
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	409 tr_etm(TgTrEtmLow, "ETM: _receive: inbuf size(%d)", size);
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	410
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	411 // Copy data payload size (size minus MID/CID byte and checksum byte)
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	412 mid = *inbuf++;
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	413
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	414 cksum = mid;
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	415 for (i = 0; i < size - 1; i++) {
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	416 cksum ^= inbuf[i];
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	417 }
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	418
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	419 if (cksum != 0) {
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	420 error = ETM_PACKET;
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	421 goto ETM_RECEIVE_END;
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	422 }
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	423
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	424 // Check it's a TM3 packet
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	425 if ((0x20 <= mid && mid < 0x27) \|\|
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	426 (0x30 <= mid && mid < 0x3A) \|\|
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	427 (0x40 <= mid && mid < 0x49) \|\|
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	428 (0x50 <= mid && mid < 0x57)) {
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	429 // Forward complete TM3 packet
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	430 error = etm_tm3_data_forward(--inbuf, size);
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	431 }
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	432 else {
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	433 /* Controlling of receptor for regisration */
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	434 for (index=0; index < etm_db_counter; index++)
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	435 {
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	436 if (etm_user_db[index].mid == mid) {
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	437 // Forward ETM packet without <mid> and <cksum>, -2 in size
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	438 error = etm_data_forward(mid, inbuf, size - 2);
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	439 break;
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	440 }
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	441 else if ((index == etm_db_counter) && (etm_user_db[index].mid != mid)) {
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	442 tr_etm(TgTrFatal, "ETM: _receive: mid(0x%x) not supported", mid);
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	443 }
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	444 }
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	445 }
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	446
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	447 ETM_RECEIVE_END:
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	448 /* Fill in Error status in ETM packet and send */
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	449 if (error) {
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	450 if (error == ETM_NOMEM) {
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	451 rvf_dump_mem();
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	452 return;
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	453 }
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	454
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	455 if ((pkt = (T_ETM_PKT *) etm_malloc(sizeof(T_ETM_PKT))) == NULL)
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	456 return;
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	457 pkt->size = 0;
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	458 pkt->mid = mid;
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	459 pkt->status = -error;
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	460
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	461 etm_pkt_send(pkt);
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	462 etm_free(pkt); // Free return Packet
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	463 }
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	464 }
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	465
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	466
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	467 /******************************************************************************
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	468 * Registration manager Functions API (Internal function)
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	469 ******************************************************************************/
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	470
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	471 int etm_database_add(T_ETM_REGISTER_REQ *msg_p, int index)
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	472 {
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	473
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	474 memcpy(etm_user_db[index].swe_name, msg_p->name, strlen(msg_p->name));
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	475 etm_user_db[index].mid = msg_p->mid;
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	476 etm_user_db[index].task_id = msg_p->task_id;
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	477 etm_user_db[index].addr_id = msg_p->addr_id;
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	478 etm_user_db[index].rx_callback_func = msg_p->rx_callback_func;
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	479
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	480 etm_user_db[index+1].mid = TABLE_END;
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	481
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	482 return ETM_OK;
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	483 }
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	484
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	485
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	486 int etm_database_manager(T_RV_HDR *msg_p)
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	487 {
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	488 int index, mid, status;
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	489
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	490 if (msg_p->msg_id == ETM_REGISTER_REQ) {
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	491 mid = ((T_ETM_REGISTER_REQ *) msg_p)->mid;
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	492
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	493 tr_etm(TgTrEtmLow,"ETM: _database_manager: _REGISTER_REQ reguest is received from (%s)",
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	494 ((T_ETM_REGISTER_REQ *) msg_p)->name);
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	495
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	496 /* Lookup in the ETM DB array */
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	497 for (index=0; index < ETM_DB_MAX; index++)
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	498 {
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	499 /* Use unregistrered space */
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	500 if ((etm_user_db[index].mid == ETM_DB_NO_USE) && (etm_user_db[index].addr_id == 0) &&
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	501 (etm_user_db[index].rx_callback_func == NULL)) {
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	502 status = etm_database_add((T_ETM_REGISTER_REQ*) msg_p, index);
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	503 etm_db_counter++;
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	504 etm_free(msg_p); // Free Message
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	505 return ETM_OK;
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	506 }
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	507 /* Reject double registration */
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	508 else if ((etm_user_db[index].mid == mid) &&
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	509 ((etm_user_db[index].addr_id != 0) \|\| (etm_user_db[index].rx_callback_func != NULL))) {
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	510 tr_etm(TgTrFatal,"ETM: _database_manager: The Module(0x%x) is registrered", mid);
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	511 etm_free(msg_p); // Free Message
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	512 return ETM_OK;
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	513 }
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	514 }
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	515
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	516 /* Add the entity to the etm database */
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	517 if (etm_db_counter < ETM_DB_MAX) {
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	518 status = etm_database_add((T_ETM_REGISTER_REQ*) msg_p, etm_db_counter);
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	519 etm_db_counter++;
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	520 etm_free(msg_p); // Free Message
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	521 return ETM_OK;
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	522 }
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	523
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	524 etm_free(msg_p); // Free Message
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	525 return ETM_DB_LIMIT;
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	526 }
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	527
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	528
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	529 if (msg_p->msg_id == ETM_UNREGISTER) {
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	530 mid = ((T_ETM_UNREGISTER *) msg_p)->mid;
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	531 tr_etm(TgTrEtmLow,"ETM: _database_manager: _UNREGISTER reguest is received from (%s)",
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	532 ((T_ETM_REGISTER_REQ *) msg_p)->name);
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	533
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	534 /* Lookup in the array, if the SWE is stocked then clean it*/
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	535 for (index=0; index < ETM_DB_MAX; index++) {
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	536 if (etm_user_db[index].mid == mid) {
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	537 etm_user_db[index].mid = ETM_DB_NO_USE;
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	538 etm_user_db[index].addr_id = 0;
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	539 etm_user_db[index].rx_callback_func = NULL;
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	540 etm_db_counter--;
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	541 etm_free(msg_p); // Free Message
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	542 return ETM_OK;
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	543 }
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	544 }
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	545
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	546 etm_free(msg_p); // Free Message
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	547 return ETM_INVAL;
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	548 }
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	549
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	550 etm_free(msg_p); // Free Message
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	551 return ETM_OK;
d78219c43fbf gsm-fw/services/etm: initial import from the Leonardo semi-src Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	552 }

FreeCalypso > hg > freecalypso-sw

annotate gsm-fw/services/etm/etm_task.c @ 865:f5affe83ba2d