fc-magnetite: src/cs/layer1/tm_cfile/l1tm

comparison src/cs/layer1/tm_cfile/l1tm_func.c @ 234:b870b6a44d31

l1audio and l1tm reconstructed source imported from tcs211-l1-reconst

author	Mychaela Falconia <falcon@freecalypso.org>
date	Mon, 20 Mar 2017 00:51:20 +0000
parents
children

comparison

equal deleted inserted replaced

-:17d79c62e638
+:b870b6a44d31
+/************* Revision Controle System Header *************
+*                  GSM Layer 1 software
+* L1TM_FUNC.C
+*
+*        Filename l1tm_func.c
+*  Copyright 2003 (C) Texas Instruments
+*
+************* Revision Controle System Header *************/
+#include "l1_macro.h"
+#include "l1_confg.h"
+#if TESTMODE
+#define L1TM_FUNC_C
+#include <string.h>
+#include <math.h>
+#include "abb.h"
+#include "general.h"
+#include "l1_types.h"
+#include "sys_types.h"
+#include "l1_const.h"
+#include "l1_time.h"
+#include "l1_signa.h"
+#include "l1tm_defty.h"
+#if 0 //(CODE_VERSION != SIMULATION)	// LoCosto-ism
+#include "pld.h"
+#endif
+#if (TRACE_TYPE==1) || (TRACE_TYPE==4) || (TRACE_TYPE==7) || (TRACE_TYPE==0)
+#include "rvt_gen.h"
+extern T_RVT_USER_ID  tm_trace_user_id;
+#endif
+#if (AUDIO_TASK == 1)
+#include "l1audio_const.h"
+#include "l1audio_cust.h"
+#include "l1audio_defty.h"
+#endif
+#if (L1_GTT == 1)
+#include "l1gtt_const.h"
+#include "l1gtt_defty.h"
+#endif
+#if (L1_MP3 == 1)
+#include "l1mp3_defty.h"
+#endif
+#if (L1_MIDI == 1)
+#include "l1midi_defty.h"
+#endif
+#include "l1_defty.h"
+#include "cust_os.h"
+#include "l1_msgty.h"
+#include "l1_varex.h"
+#include "l1_proto.h"
+#include "mem.h"
+#if (CODE_VERSION != SIMULATION)
+#if (RF_FAM == 61)
+#include "tpudrv61.h"
+#include "l1_rf61.h"
+#include "l1tm_tpu61.h"
+#if (DRP_FW_EXT==1)
+#include "l1_drp_inc.h"
+#else
+#include "drp_drive.h"
+#endif
+#endif
+#if (RF_FAM == 60)
+#include "tpudrv60.h"
+#include "l1_rf60.h"
+#include "l1tm_tpu60.h"
+#include "drp_drive.h"
+#endif
+#if (RF_FAM==43)
+#include "tpudrv43.h"
+#include "l1_rf43.h"
+#include "l1tm_tpu43.h"
+#endif
+#if (RF_FAM == 35)
+#include "tpudrv35.h"
+#include "l1_rf35.h"
+#include "l1tm_tpu35.h"
+#endif
+#if (RF_FAM == 12)
+#include "tpudrv12.h"
+#include "l1_rf12.h"
+#include "l1tm_tpu12.h"
+#endif
+#if (RF_FAM == 10)
+#include "tpudrv10.h"
+#include "l1_rf10.h"
+#include "l1tm_tpu10.h"
+#endif
+#if (RF_FAM == 8)
+#include "tpudrv8.h"
+#include "l1_rf8.h"
+#include "l1tm_tpu8.h"
+#endif
+#if (RF_FAM == 2)
+#include "tpudrv2.h"
+#include "l1_rf2.h"
+#include "l1tm_tpu2.h"
+#endif
+#else
+#if (RF_FAM == 2)
+#include "l1_rf2.h"
+#endif
+#endif
+#include <assert.h>
+#include <string.h>
+#include "l1tm_msgty.h"
+#include "l1tm_signa.h"
+#include "l1tm_varex.h"
+#include "l1tm_ver.h"
+#if L1_GPRS
+#include "l1p_cons.h"
+#include "l1p_msgt.h"
+#include "l1p_deft.h"
+#include "l1p_vare.h"
+#include "l1p_sign.h"
+#endif
+#if ((L1_STEREOPATH == 1) && (OP_L1_STANDALONE == 1))
+#include "sys_dma.h"
+#endif
+#if(L1_FF_MULTIBAND == 1)
+extern UWORD8 tm_band;
+#endif /*if (L1_FF_MULTIBAND == 1)*/
+// Prototypes from external functions
+//------------------------------------
+UWORD16 Convert_l1_radio_freq(SYS_UWORD16 radio_freq);
+void Cust_tm_rf_param_write        (T_TM_RETURN *tm_return, WORD16 index, UWORD16 value);
+void Cust_tm_rf_param_read         (T_TM_RETURN *tm_return, WORD16 index);
+void Cust_tm_rf_table_write        (T_TM_RETURN *tm_return, WORD8 index, UWORD8 size, UWORD8 table[]);
+void Cust_tm_rf_table_read         (T_TM_RETURN *tm_return, WORD8 index);
+void Cust_tm_rx_param_write        (T_TM_RETURN *tm_return, WORD16 index, UWORD16 value);
+void Cust_tm_rx_param_read         (T_TM_RETURN *tm_return, WORD16 index);
+void Cust_tm_tx_param_write        (T_TM_RETURN *tm_return, WORD16 index, UWORD16 value, UWORD8 band);
+void Cust_tm_tx_param_read         (T_TM_RETURN *tm_return, WORD16 index, UWORD8 band);
+void Cust_tm_tx_template_write     (T_TM_RETURN *tm_return, WORD8 index, UWORD8 size, UWORD8 table[]);
+void Cust_tm_tx_template_read      (T_TM_RETURN *tm_return, WORD8 index);
+void Cust_tm_special_param_write   (T_TM_RETURN *tm_return, WORD16 index, UWORD16 value);
+void Cust_tm_special_param_read    (T_TM_RETURN *tm_return, WORD16 index);
+void Cust_tm_special_table_write   (T_TM_RETURN *tm_return, WORD8 index, UWORD8 size, UWORD8 table[]);
+void Cust_tm_special_table_read    (T_TM_RETURN *tm_return, WORD8 index);
+void Cust_tm_special_enable        (T_TM_RETURN *tm_return, WORD16 action);
+#if (CODE_VERSION != SIMULATION)
+void Cust_tm_tpu_table_write       (T_TM_RETURN *tm_return, WORD8 index, UWORD8 size, UWORD8 table[]);
+void Cust_tm_tpu_table_read        (T_TM_RETURN *tm_return, WORD8 index);
+#endif
+//------------------------------------
+// Prototypes from external functions
+//------------------------------------
+void Cust_tm_init                   (void);
+void l1tm_reset_rx_state            (void);
+void l1tm_reset_rx_stats            (void);
+#if L1_GPRS
+void l1pa_reset_cr_freq_list      (void);
+#endif
+//------------------------------------
+// Prototypes from internal functions
+//------------------------------------
+void l1tm_initialize_var(void);
+UWORD16 l1tm_convert_arfcn2l1ch(UWORD16 arfcn, UWORD8 *error_flag);
+void l1tm_stats_read(T_TM_RETURN *tm_return, WORD16 type, UWORD16 bitmask);
+void tm_transmit(T_TM_RETURN *tm_ret);
+void l1tm_PRBS1_generate(UWORD16 *TM_ul_data);
+#if ((L1_STEREOPATH == 1) && (OP_L1_STANDALONE == 1))
+void l1tm_stereopath_DMA_handler(SYS_UWORD16 dma_status);
+void l1tm_stereopath_fill_buffer(void* buffer_address);
+UWORD16 l1tm_stereopath_get_pattern(UWORD16 sampling_freq, UWORD16 sin_freq_left,UWORD16 sin_freq_right, UWORD8 data_type);
+#endif
+/***********************************************************************/
+/*                           TESTMODE 3.X                              */
+/***********************************************************************/
+static UWORD8 tx_param_band=0;  // used in tx_param_write/read; default is GSM900
+// RF,(ANALOG)or other hardware dependent functions
+// - work done by tmrf.c functions for each product.
+// TestMode functions that modify the state variables
+// within the L1A - may need to allocate space
+// dynamically if this is the first time calling
+// these functions.
+// TestMode functions that start L1A state machines
+// may need to send L1A primitives to change L1A state.
+void l1tm_rf_param_write(T_TESTMODE_PRIM *prim, T_TM_RETURN *tm_return)
+{
+tm_return->index = prim->u.tm_params.index;
+tm_return->size = 0;
+switch (prim->u.tm_params.index)
+{
+	  #if (FF_REPEATED_SACCH == 1)
+	      // Repeated SACCH mode
+	   case REPEATED_SACCH_ENA_FLAG:
+	   {
+	    l1_config.repeat_sacch_enable = prim->u.tm_params.value;
+	    #if (ETM_PROTOCOL == 1)
+	            tm_return->status = -ETM_OK;
+	    #else
+	            tm_return->status = E_OK;
+	    #endif
+	          break;
+	      }
+	  #endif /* FF_REPEATED_SACCH */
+	  #if (FF_REPEATED_DL_FACCH == 1)
+	      // Repeated FACCH mode
+	      case REPEATED_FACCHDL_ENA_FLAG:
+	      {
+	          l1_config.repeat_facch_dl_enable = prim->u.tm_params.value;
+	       #if (ETM_PROTOCOL == 1)
+	            tm_return->status = -ETM_OK;
+	       #else
+	            tm_return->status = E_OK;
+	       #endif/*(ETM_PROTOCOL == 1)*/
+	       break;
+	      }
+#endif /* FF_REPEATED_DL_FACCH == 1 */
+case BCCH_ARFCN:
+{
+UWORD16 bcch_arfcn;
+UWORD8  error_flag;
+bcch_arfcn = l1tm_convert_arfcn2l1ch(prim->u.tm_params.value, &error_flag);
+if (error_flag)
+{
+#if (ETM_PROTOCOL == 1)
+tm_return->status = -ETM_INVAL;
+#else
+tm_return->status = E_INVAL;
+#endif
+}
+else
+{
+l1_config.tmode.rf_params.bcch_arfcn = bcch_arfcn;
+// now change on the fly
+// no reason to check dedicated_active flag...
+// we just set these 2 globals for FB/SB/BCCH tests
+l1a_l1s_com.nsync.list[0].radio_freq = l1_config.tmode.rf_params.bcch_arfcn;
+l1a_l1s_com.Scell_info.radio_freq    = l1_config.tmode.rf_params.bcch_arfcn;
+#if (ETM_PROTOCOL == 1)
+tm_return->status = -ETM_OK;
+#else
+tm_return->status = E_OK;
+#endif
+}
+break;
+}
+case TCH_ARFCN:
+{
+T_CHN_SEL *chan_sel;
+UWORD16    tch_arfcn;
+UWORD8     error_flag;
+tch_arfcn = l1tm_convert_arfcn2l1ch(prim->u.tm_params.value, &error_flag);
+if (error_flag)
+#if (ETM_PROTOCOL == 1)
+tm_return->status = -ETM_INVAL;
+#else
+tm_return->status = E_INVAL;
+#endif
+else
+{
+l1_config.tmode.rf_params.tch_arfcn = tch_arfcn;
+// now change on the fly if necessary
+if (l1_config.TestMode && l1tm.tmode_state.dedicated_active)
+{
+chan_sel = &(l1a_l1s_com.dedic_set.aset->achan_ptr->desc_ptr->chan_sel);
+chan_sel->rf_channel.single_rf.radio_freq = l1_config.tmode.rf_params.tch_arfcn;
+}
+#if (ETM_PROTOCOL == 1)
+tm_return->status = -ETM_OK;
+#else
+tm_return->status = E_OK;
+#endif
+}
+break;
+}
+case MON_ARFCN:
+{
+UWORD16 mon_arfcn;
+UWORD8  error_flag;
+mon_arfcn = l1tm_convert_arfcn2l1ch(prim->u.tm_params.value, &error_flag);
+if (error_flag)
+#if (ETM_PROTOCOL == 1)
+tm_return->status = -ETM_INVAL;
+#else
+tm_return->status = E_INVAL;
+#endif
+else
+{
+l1_config.tmode.rf_params.mon_arfcn = mon_arfcn;
+#if (ETM_PROTOCOL == 1)
+tm_return->status = -ETM_OK;
+#else
+tm_return->status = E_OK;
+#endif
+}
+break;
+}
+#if L1_GPRS
+case PDTCH_ARFCN:
+{
+UWORD16    pdtch_arfcn;
+UWORD8     error_flag;
+pdtch_arfcn = l1tm_convert_arfcn2l1ch(prim->u.tm_params.value, &error_flag);
+if (error_flag)
+#if (ETM_PROTOCOL == 1)
+tm_return->status = -ETM_INVAL;
+#else
+tm_return->status = E_INVAL;
+#endif
+else
+{
+l1_config.tmode.rf_params.pdtch_arfcn = pdtch_arfcn;
+#if (ETM_PROTOCOL == 1)
+tm_return->status = -ETM_OK;
+#else
+tm_return->status = E_OK;
+#endif
+}
+break;
+}
+#endif
+case AFC_ENA_FLAG:
+{
+l1_config.afc_enable = prim->u.tm_params.value;
+#if (ETM_PROTOCOL == 1)
+tm_return->status = -ETM_OK;
+#else
+tm_return->status = E_OK;
+#endif
+break;
+}
+case AFC_DAC_VALUE:
+{
+WORD16 afc_value = prim->u.tm_params.value;
+// 13-bit AFC DAC
+#if(RF_FAM != 61)
+if (afc_value<-4096 || afc_value>4095)
+#else
+if (afc_value<-8192 || afc_value>8191)
+#endif
+{
+#if (ETM_PROTOCOL == 1)
+tm_return->status = -ETM_INVAL;
+#else
+tm_return->status = E_INVAL;
+#endif
+break;
+}
+if (!l1_config.afc_enable)
+{
+// write AFC value to AFC DAC ASAP!! AFC DAC will be updated by any RX
+// or TX test.
+l1s.afc = afc_value;
+}
+#if (ETM_PROTOCOL == 1)
+tm_return->status = -ETM_OK;
+#else
+tm_return->status = E_OK;
+#endif
+break;
+}
+#if L1_GPRS
+case MULTISLOT_CLASS:
+{
+UWORD8    multislot_class;
+multislot_class = prim->u.tm_params.value;
+if ((multislot_class < 1) || (multislot_class > 12))
+#if (ETM_PROTOCOL == 1)
+tm_return->status = -ETM_INVAL;
+#else
+tm_return->status = E_INVAL;
+#endif
+else
+{
+l1_config.tmode.rf_params.multislot_class = multislot_class;
+#if (ETM_PROTOCOL == 1)
+tm_return->status = -ETM_OK;
+#else
+tm_return->status = E_OK;
+#endif
+}
+break;
+}
+#endif // end of L1_GPRS
+default:
+{
+Cust_tm_rf_param_write(tm_return,
+prim->u.tm_params.index,
+prim->u.tm_params.value);
+break;
+}
+} // end switch
+}
+UWORD16 l1tm_convert_arfcn2l1ch(UWORD16 arfcn, UWORD8 *error_flag)
+#if (L1_FF_MULTIBAND == 0)
+{
+/*  Here, before we store the channel numbers to the l1_config structure,
+we convert from ETSI to TI channel numbering system.  The GGT
+ALWAYS expects the ETSI numbering system as input and output.
+We need to do the OPPOSITE of what is done in convert_l1_arfcn() in
+tpudrvX.c
+***************************************
+*** convert arfcn's from ETSI to TI ***
+***************************************
+**                                   **
+**     ETSI                 TI       **
+**           0   GSM          174    **
+**    1 -  124   GSM      1 - 124    **
+**  975 - 1023  E-GSM   125 - 173    **
+**  512 -  885   DCS    174 - 548    **
+**                                   **
+***************************************      */
+*error_flag = 0;
+switch (l1_config.std.id)
+{
+case GSM:
+case DCS1800:
+case PCS1900:
+case GSM850:
+break;
+case DUAL:
+if ((arfcn >= 512) && (arfcn <= 885)) arfcn -= 337;
+else if (arfcn > 124) *error_flag = 1; // invalid arfcn
+break;
+case DUALEXT:
+if (arfcn == 0) arfcn = 174;
+else if ((arfcn >= 975) && (arfcn <= 1023)) arfcn -= 850;
+else if ((arfcn >= 512) && (arfcn <= 885))  arfcn -= 337;
+else if ((arfcn >= 1)   && (arfcn <= 124));
+else *error_flag = 1; // invalide arfcn
+break;
+case DUAL_US:  // GSM850:128-251  PCS1900:512-810
+if ((arfcn >= 128) && (arfcn <= 251)) arfcn -= 127;
+else if ((arfcn >= 512) && (arfcn <= 810)) arfcn -= 387;
+else *error_flag = 1; // invalid arfcn
+break;
+default:
+*error_flag = 1; // invalid std.id
+break;
+} // end switch
+return arfcn;
+}
+#else // L1_FF_MULTIBAND = 1 below
+{
+*error_flag=0;
+if(tm_band == RF_PCS1900)
+{
+arfcn = arfcn + 512;
+}
+return(arfcn);
+#if 0
+UWORD16 l1_radio_freq = 0;
+UWORD8 effective_band_id = 0;
+*error_flag = 1;
+for (effective_band_id = 0; effective_band_id < RF_NB_SUBBANDS; effective_band_id ++)
+{
+if( multiband_conversion_data[effective_band_id].physical_band_id == tm_band)
+{
+if( (arfcn - multiband_conversion_data[effective_band_id].first_tpu_radio_freq) < multiband_conversion_data[effective_band_id].nbmax_carrier)
+{
+l1_radio_freq =   arfcn - multiband_conversion_data[effective_band_id].first_tpu_radio_freq + multiband_conversion_data[effective_band_id].first_radio_freq;
+*error_flag = 0;
+return(l1_radio_freq);
+}
+}
+}
+return(l1_radio_freq);
+#endif
+}
+#endif // #if (L1_FF_MULTIBAND == 0) else
+void l1tm_rf_param_read(T_TESTMODE_PRIM *prim, T_TM_RETURN *tm_return)
+{
+volatile UWORD16 value;
+tm_return->index = prim->u.tm_params.index;
+switch (prim->u.tm_params.index)
+{
+#if (FF_REPEATED_SACCH == 1 )
+/* Repeated SACCH mode */
+case REPEATED_SACCH_ENA_FLAG:
+{
+value = l1_config.repeat_sacch_enable;
+break;
+}
+#endif /* FF_REPEATED_SACCH */
+#if FF_REPEATED_DL_FACCH
+// Repeated FACCH mode
+case REPEATED_FACCHDL_ENA_FLAG:
+{
+value = l1_config.repeat_facch_dl_enable;
+break;
+}
+#endif /* FF_REPEATED_DL_FACCH */
+case BCCH_ARFCN:
+{
+// return ETSI value for channel number
+value = Convert_l1_radio_freq(l1_config.tmode.rf_params.bcch_arfcn);
+break;
+}
+case TCH_ARFCN:
+{
+// return ETSI value for channel number
+value = Convert_l1_radio_freq(l1_config.tmode.rf_params.tch_arfcn);
+break;
+}
+case MON_ARFCN:
+{
+// return ETSI value for channel number
+value = Convert_l1_radio_freq(l1_config.tmode.rf_params.mon_arfcn);
+break;
+}
+#if L1_GPRS
+case PDTCH_ARFCN:
+{
+// return ETSI value for channel number
+value = Convert_l1_radio_freq(l1_config.tmode.rf_params.pdtch_arfcn);
+break;
+}
+#endif
+case AFC_ENA_FLAG:
+{
+value = l1_config.afc_enable;
+break;
+}
+case AFC_DAC_VALUE:
+{
+value = l1s.afc; // returned as F13.3
+break;
+}
+#if L1_GPRS
+case MULTISLOT_CLASS:
+{
+value = l1_config.tmode.rf_params.multislot_class;
+break;
+}
+#endif
+default:
+{
+Cust_tm_rf_param_read(tm_return, prim->u.tm_params.index);
+return;
+}
+} // end switch
+memcpy(tm_return->result, (UWORD8 *)&value, 2);
+tm_return->size = 2;
+#if (ETM_PROTOCOL == 1)
+tm_return->status = -ETM_OK;
+#else
+tm_return->status = E_OK;
+#endif
+}
+void l1tm_rf_table_write(T_TESTMODE_PRIM *prim, T_TM_RETURN *tm_return)
+{
+Cust_tm_rf_table_write(tm_return,
+prim->u.tm_table.index,
+prim->str_len_in_bytes - 1,    // subtract 8-bit index
+prim->u.tm_table.table);
+}
+void l1tm_rf_table_read(T_TESTMODE_PRIM *prim, T_TM_RETURN *tm_return)
+{
+Cust_tm_rf_table_read(tm_return, prim->u.tm_table.index);
+}
+void l1tm_rx_param_write(T_TESTMODE_PRIM *prim, T_TM_RETURN *tm_return)
+{
+tm_return->index = prim->u.tm_params.index;
+tm_return->size = 0;
+switch (prim->u.tm_params.index)
+{
+case RX_AGC_GAIN:
+{
+WORD8 gain = prim->u.tm_params.value;
+// It is up to the user to write a valid gain,
+// one that falls within the range of gains in the current RF
+// AGC gain can only be controlled in 2dB steps as the bottom bit (bit zero)
+// corresponds to the lna_off bit
+l1_config.tmode.rx_params.agc     = gain & ~0x01;
+l1_config.tmode.rx_params.lna_off = gain &  0x01;
+#if (ETM_PROTOCOL == 1)
+tm_return->status = -ETM_OK;
+#else
+tm_return->status = E_OK;
+#endif
+break;
+}
+case RX_TIMESLOT:
+{
+if (prim->u.tm_params.value > 7)
+{
+#if (ETM_PROTOCOL == 1)
+tm_return->status = -ETM_INVAL;
+#else
+tm_return->status = E_INVAL;
+#endif
+break;
+}
+l1_config.tmode.rx_params.slot_num = prim->u.tm_params.value;
+if (l1_config.TestMode && l1tm.tmode_state.dedicated_active)
+{
+// currently CANNOT change RX slot on the fly!
+}
+#if (ETM_PROTOCOL == 1)
+tm_return->status = -ETM_OK;
+#else
+tm_return->status = E_OK;
+#endif
+break;
+}
+case RX_PM_ENABLE:
+{
+l1_config.tmode.rx_params.pm_enable = prim->u.tm_params.value;
+#if (ETM_PROTOCOL == 1)
+tm_return->status = -ETM_OK;
+#else
+tm_return->status = E_OK;
+#endif
+break;
+}
+#if L1_GPRS
+case RX_GPRS_SLOTS:
+{
+// At least one DL TS needs to be allocated
+if (!prim->u.tm_params.value)
+#if (ETM_PROTOCOL == 1)
+tm_return->status = -ETM_INVAL;
+#else
+tm_return->status = E_INVAL;
+#endif
+else
+{
+l1_config.tmode.rx_params.timeslot_alloc = prim->u.tm_params.value;
+#if (ETM_PROTOCOL == 1)
+tm_return->status = -ETM_OK;
+#else
+tm_return->status = E_OK;
+#endif
+}
+break;
+}
+case RX_GPRS_CODING:
+{
+UWORD8 coding_scheme;
+coding_scheme = prim->u.tm_params.value;
+if ((coding_scheme < 1) || (coding_scheme > 6) || (coding_scheme == 3))
+#if (ETM_PROTOCOL == 1)
+tm_return->status = -ETM_INVAL;
+#else
+tm_return->status = E_INVAL;
+#endif
+else
+{
+l1_config.tmode.rx_params.coding_scheme = prim->u.tm_params.value;
+#if (ETM_PROTOCOL == 1)
+tm_return->status = -ETM_OK;
+#else
+tm_return->status = E_OK;
+#endif
+}
+break;
+}
+#endif
+case RX_AGC_ENA_FLAG:
+{
+l1_config.agc_enable = prim->u.tm_params.value;
+#if (ETM_PROTOCOL == 1)
+tm_return->status = -ETM_OK;
+#else
+tm_return->status = E_OK;
+#endif
+break;
+}
+default:
+{
+Cust_tm_rx_param_write(tm_return,
+prim->u.tm_params.index,
+prim->u.tm_params.value);
+break;
+}
+} // end switch
+}
+void l1tm_rx_param_read(T_TESTMODE_PRIM *prim, T_TM_RETURN *tm_return)
+{
+volatile UWORD16 value;
+tm_return->index = prim->u.tm_params.index;
+switch (prim->u.tm_params.index)
+{
+case RX_AGC_GAIN:
+{
+value = l1_config.tmode.rx_params.agc | l1_config.tmode.rx_params.lna_off;
+break;
+}
+case RX_TIMESLOT:
+{
+value = l1_config.tmode.rx_params.slot_num;
+break;
+}
+case RX_AGC_ENA_FLAG:
+{
+value = l1_config.agc_enable;
+break;
+}
+case RX_PM_ENABLE:
+{
+value = l1_config.tmode.rx_params.pm_enable;
+break;
+}
+#if L1_GPRS
+case RX_GPRS_SLOTS:
+{
+value = l1_config.tmode.rx_params.timeslot_alloc;
+break;
+}
+case RX_GPRS_CODING:
+{
+value = l1_config.tmode.rx_params.coding_scheme;
+break;
+}
+#endif
+default:
+{
+Cust_tm_rx_param_read(tm_return, prim->u.tm_params.index);
+return;
+}
+} // end switch
+memcpy(tm_return->result, (UWORD8 *)&value, 2);
+tm_return->size = 2;
+#if (ETM_PROTOCOL == 1)
+tm_return->status = -ETM_OK;
+#else
+tm_return->status = E_OK;
+#endif
+}
+void l1tm_tx_param_write(T_TESTMODE_PRIM *prim, T_TM_RETURN *tm_return)
+{
+tm_return->index = prim->u.tm_params.index;
+tm_return->size = 0;
+switch (prim->u.tm_params.index)
+{
+case TX_PWR_LEVEL:
+{
+UWORD8 temp_txpwr, temp_band;
+if (prim->u.tm_params.value < 100)  // GSM900
+{
+temp_txpwr = prim->u.tm_params.value;
+temp_band = 0;
+}
+else if (prim->u.tm_params.value < 200)  // DCS1800
+{
+temp_txpwr = prim->u.tm_params.value - 100;
+temp_band = 1;
+}
+else if (prim->u.tm_params.value < 300)  // PCS1900
+{
+temp_txpwr = prim->u.tm_params.value - 200;
+temp_band = 2;
+}
+else  // force invalid values to return -ETM_INVAL or E_INVAL
+{
+temp_txpwr = 50;
+temp_band = 10;
+}
+// Note that the pwr level is only checked for being within the range [0..31]
+// because all pwr levels should be testable.
+// For subfunctions [TX_APC_DAC..TX_DELAY_DOWN]:
+//     temp_txpwr +   0 ==> GSM900
+//     temp_txpwr + 100 ==> DCS1800
+//     temp_txpwr + 200 ==> PCS1900
+// Changing tx pwr level on the fly while in continuous mode is not supported.
+if (temp_txpwr > 31 || temp_band > 2 ||
+l1_config.tmode.rf_params.tmode_continuous == TM_CONTINUOUS)
+{
+#if (ETM_PROTOCOL == 1)
+tm_return->status = -ETM_INVAL;
+#else
+tm_return->status = E_INVAL;
+#endif
+break;
+}
+l1_config.tmode.tx_params.txpwr = temp_txpwr;
+tx_param_band = temp_band;
+// if in TX mode, change txpwr on the fly
+if ((l1_config.TestMode) &&
+(l1tm.tmode_state.dedicated_active) &&
+(l1_config.tmode.rf_params.down_up & TMODE_UPLINK))
+{
+// this causes 'direct' changing of TXPWR, which is OK in TestMode
+l1a_l1s_com.dedic_set.aset->new_target_txpwr = l1s.applied_txpwr = l1_config.tmode.tx_params.txpwr;
+}
+#if (ETM_PROTOCOL == 1)
+tm_return->status = -ETM_OK;
+#else
+tm_return->status = E_OK;
+#endif
+break;
+}
+case TX_TIMING_ADVANCE:
+{
+l1_config.tmode.tx_params.timing_advance = prim->u.tm_params.value;
+if (l1_config.TestMode && l1tm.tmode_state.dedicated_active)
+{
+// direct changing of Timing Advance
+l1a_l1s_com.dedic_set.aset->new_timing_advance = l1_config.tmode.tx_params.timing_advance;
+// new TA to take effect immediately
+l1a_l1s_com.dedic_set.aset->timing_advance = l1a_l1s_com.dedic_set.aset->new_timing_advance;
+}
+#if (ETM_PROTOCOL == 1)
+tm_return->status = -ETM_OK;
+#else
+tm_return->status = E_OK;
+#endif
+break;
+}
+case TX_PWR_SKIP:
+{
+l1_config.tmode.tx_params.txpwr_skip = prim->u.tm_params.value;
+#if (ETM_PROTOCOL == 1)
+tm_return->status = -ETM_OK;
+#else
+tm_return->status = E_OK;
+#endif
+break;
+}
+#if L1_GPRS
+case TX_GPRS_POWER0:
+case TX_GPRS_POWER1:
+case TX_GPRS_POWER2:
+case TX_GPRS_POWER3:
+case TX_GPRS_POWER4:
+case TX_GPRS_POWER5:
+case TX_GPRS_POWER6:
+case TX_GPRS_POWER7:
+{
+l1_config.tmode.tx_params.txpwr_gprs[prim->u.tm_params.index - TX_GPRS_POWER0] = prim->u.tm_params.value;
+#if (ETM_PROTOCOL == 1)
+tm_return->status = -ETM_OK;
+#else
+tm_return->status = E_OK;
+#endif
+break;
+}
+case TX_GPRS_SLOTS:
+{
+l1_config.tmode.tx_params.timeslot_alloc = prim->u.tm_params.value;
+#if (ETM_PROTOCOL == 1)
+tm_return->status = -ETM_OK;
+#else
+tm_return->status = E_OK;
+#endif
+break;
+}
+case TX_GPRS_CODING:
+{
+UWORD8 coding_scheme;
+coding_scheme = prim->u.tm_params.value;
+if ((coding_scheme < 2) || (coding_scheme > 6) || (coding_scheme == 3))
+#if (ETM_PROTOCOL == 1)
+tm_return->status = -ETM_INVAL;
+#else
+tm_return->status = E_INVAL;
+#endif
+else
+{
+l1_config.tmode.tx_params.coding_scheme = prim->u.tm_params.value;
+#if (ETM_PROTOCOL == 1)
+tm_return->status = -ETM_OK;
+#else
+tm_return->status = E_OK;
+#endif
+}
+break;
+}
+#endif
+default:
+{
+Cust_tm_tx_param_write(tm_return,
+prim->u.tm_params.index,
+prim->u.tm_params.value,
+tx_param_band);
+break;
+}
+} // end switch
+}
+void l1tm_tx_param_read(T_TESTMODE_PRIM *prim, T_TM_RETURN *tm_return)
+{
+tm_return->index = prim->u.tm_params.index;
+Cust_tm_tx_param_read(tm_return,
+prim->u.tm_params.index,
+tx_param_band);
+}
+void l1tm_tx_template_write(T_TESTMODE_PRIM *prim, T_TM_RETURN *tm_return)
+{
+Cust_tm_tx_template_write(tm_return,
+prim->u.tm_table.index,
+prim->str_len_in_bytes - 1, // subtract 8-bit index
+prim->u.tm_table.table);
+}
+void l1tm_tx_template_read(T_TESTMODE_PRIM *prim, T_TM_RETURN *tm_return)
+{
+Cust_tm_tx_template_read(tm_return, prim->u.tm_table.index);
+}
+/* TCS211 function missing in LoCosto, reconstructed from disassembly */
+void l1tm_mode_set(T_TESTMODE_PRIM *prim, T_TM_RETURN *tm_return)
+{
+switch (prim->u.tm_params.index) {
+case 0:
+l1_config.TestMode = 0;
+tm_return->status = E_OK;
+break;
+case 1:
+l1_config.TestMode = 1;
+l1_config.tx_pwr_code = 1;
+l1_config.pwr_mngt = 0;
+tm_return->status = E_OK;
+Cust_tm_init();
+l1tm_initialize_var();
+break;
+default:
+tm_return->status = E_INVAL;
+}
+tm_return->index = 0;
+tm_return->size = 0;
+}
+/* TCS211 function missing in LoCosto, reconstructed from disassembly */
+void l1tm_version_get(T_TESTMODE_PRIM *prim, T_TM_RETURN *tm_return)
+{
+UWORD16 revision;
+extern  T_RF rf;
+tm_return->index = prim->u.tm_params.index;
+switch (prim->u.tm_params.index) {
+/* "meat" of this switch statement taken from LoCosto etm_tm3core.c */
+case BBCHIP_MODULE_REV:
+revision = CHIPSET;
+break;
+case CHIPID_MODULE_REV:
+revision = *( (volatile UWORD16 *) (MEM_JTAGID_PART));
+break;
+case CHIPVER_MODULE_REV:
+revision = *( (volatile UWORD16 *) (MEM_JTAGID_VER));
+break;
+case DSPSW_MODULE_REV:
+revision = l1s.version.dsp_code_version;
+break;
+case ANALOGCHIP_MODULE_REV:
+revision = ((ANLG_PG << 7) | ANLG_FAM);
+break;
+case LAYER1_MODULE_REV:
+revision = l1s.version.mcu_tcs_official;
+break;
+case RFDRIVER_MODULE_REV:
+revision = rf.rf_revision;
+break;
+case TM_API_MODULE_REV:
+revision = TMAPIVERSION;
+break;
+case L1_TM_CORE_MODULE_REV:
+revision = l1s.version.mcu_tm_version;
+break;
+case DSP_MODULE_REV:
+revision = DSP;
+break;
+case RF_MODULE_REV:
+revision = ((RF_PA << 10) | (RF_PG << 7) | RF_FAM);
+break;
+default:
+tm_return->status = E_BADINDEX;
+tm_return->size = 0;
+return;
+}
+memcpy(tm_return->result, &revision, sizeof revision);
+tm_return->size = sizeof revision;
+tm_return->status = E_OK;
+}
+/* TCS211 function missing in LoCosto, reconstructed from disassembly */
+void l1tm_mem_write(T_TESTMODE_PRIM *prim, T_TM_RETURN *tm_return)
+{
+UWORD8 *mem_ptr;
+UWORD8 num_of_bytes;
+UWORD16 i;
+mem_ptr = (UWORD8 *) prim->u.mem_write.address;
+num_of_bytes = prim->str_len_in_bytes - 4;
+for (i = 0; i < num_of_bytes; i++)
+mem_ptr[i] = prim->u.mem_write.table[i];
+tm_return->size = 0;
+tm_return->index = 0;
+tm_return->status = E_OK;
+}
+/* TCS211 function missing in LoCosto, reconstructed from disassembly */
+void l1tm_mem_read(T_TESTMODE_PRIM *prim, T_TM_RETURN *tm_return)
+{
+tm_return->index = 0;
+if (prim->u.mem_read.length > TM_PAYLOAD_UPLINK_SIZE_MAX - 4) {
+tm_return->size = 0;
+tm_return->status = E_BADSIZE;
+return;
+}
+memcpy(tm_return->result, &prim->u.mem_read.length, 4);
+memcpy(tm_return->result + 4, (UWORD8 *) prim->u.mem_read.src,
+prim->u.mem_read.length);
+tm_return->size = prim->u.mem_read.length + 4;
+tm_return->status = E_OK;
+}
+/* TCS211 function missing in LoCosto, reconstructed from disassembly */
+void l1tm_codec_write(T_TESTMODE_PRIM *prim, T_TM_RETURN *tm_return)
+{
+UWORD16 page, reg;
+page = (prim->u.tm_params.index >> 5) & 1;
+reg = prim->u.tm_params.index & 0x1F;
+if (!l1_config.TestMode) {
+tm_return->status = E_TESTMODE;
+goto out;
+}
+if (page >= 2 || reg >= 32) {
+tm_return->status = E_INVAL;
+goto out;
+}
+ABB_Write_Register_on_page(page + 1, reg << 1,
+prim->u.tm_params.value & 0x3FF);
+tm_return->status = E_OK;
+out:
+tm_return->index = 0;
+tm_return->size = 0;
+}
+/* TCS211 function missing in LoCosto, reconstructed from disassembly */
+void l1tm_codec_read(T_TESTMODE_PRIM *prim, T_TM_RETURN *tm_return)
+{
+UWORD16 page, reg;
+UWORD16 value;
+page = (prim->u.tm_params.index >> 5) & 1;
+reg = prim->u.tm_params.index & 0x1F;
+value = ABB_Read_Register_on_page(page + 1, reg << 1);
+memcpy(tm_return->result, &value, 2);
+tm_return->size = 2;
+tm_return->status = E_OK;
+tm_return->index = 0;
+}
+/* TCS211 function missing in LoCosto, reconstructed from disassembly */
+void l1tm_misc_param_write(T_TESTMODE_PRIM *prim, T_TM_RETURN *tm_return)
+{
+tm_return->index = prim->u.tm_params.index;
+tm_return->size = 0;
+switch (prim->u.tm_params.index) {
+case ADC_ENA_FLAG:
+l1_config.adc_enable = prim->u.tm_params.value;
+break;
+default:
+Cust_tm_misc_param_write(tm_return, prim->u.tm_params.index,
+prim->u.tm_params.value);
+return;
+}
+tm_return->status = E_OK;
+}
+/* TCS211 function missing in LoCosto, reconstructed from disassembly */
+void l1tm_misc_param_read(T_TESTMODE_PRIM *prim, T_TM_RETURN *tm_return)
+{
+UWORD16 value;
+tm_return->index = prim->u.tm_params.index;
+switch (prim->u.tm_params.index) {
+case ADC_ENA_FLAG:
+value = l1_config.adc_enable;
+break;
+case CURRENT_TM_MODE:
+value = l1_config.TestMode;
+break;
+default:
+Cust_tm_misc_param_read(tm_return, prim->u.tm_params.index);
+return;
+}
+memcpy(tm_return->result, &value, 2);
+tm_return->size = 2;
+tm_return->status = E_OK;
+}
+/* TCS211 function missing in LoCosto, reconstructed from disassembly */
+void l1tm_misc_enable(T_TESTMODE_PRIM *prim, T_TM_RETURN *tm_return)
+{
+Cust_tm_misc_enable(tm_return, prim->u.tm_params.index);
+}
+void l1tm_special_param_write(T_TESTMODE_PRIM *prim, T_TM_RETURN *tm_return)
+{
+Cust_tm_special_param_write(tm_return,
+prim->u.tm_params.index,
+prim->u.tm_params.value);
+}
+void l1tm_special_param_read(T_TESTMODE_PRIM *prim, T_TM_RETURN *tm_return)
+{
+Cust_tm_special_param_read(tm_return, prim->u.tm_params.index);
+}
+void l1tm_special_table_write(T_TESTMODE_PRIM *prim, T_TM_RETURN *tm_return)
+{
+Cust_tm_special_table_write(tm_return,
+prim->u.tm_table.index,
+prim->str_len_in_bytes - 1,
+prim->u.tm_table.table);
+}
+void l1tm_special_table_read(T_TESTMODE_PRIM *prim, T_TM_RETURN *tm_return)
+{
+Cust_tm_special_table_read(tm_return, prim->u.tm_table.index);
+}
+void l1tm_special_enable(T_TESTMODE_PRIM *prim, T_TM_RETURN *tm_return)
+{
+Cust_tm_special_enable(tm_return, prim->u.tm_params.index);
+}
+/* TCS211 function missing in LoCosto, reconstructed from disassembly */
+void l1tm_initialize(T_TM_RETURN *tm_return)
+{
+Cust_tm_init();
+tm_return->status = E_OK;
+tm_return->size = 0;
+tm_return->index = 0;
+}
+/* TCS211 function missing in LoCosto, reconstructed from disassembly */
+void l1tm_ffs(T_TESTMODE_PRIM *prim, T_TM_RETURN *tm_return)
+{
+tm_return->size = tm_ffs(tm_return->result, 32, prim->u.ffs.packet,
+prim->str_len_in_bytes);
+tm_return->status = E_OK;
+tm_return->index = 0;
+}
+/*-------------------------------------------------------*/
+/* l1tm_initialize_var()                                 */
+/*-------------------------------------------------------*/
+/* Parameters  :                                         */
+/* -------------                                         */
+/* Return      :                                         */
+/* -------------                                         */
+/* Description :                                         */
+/* -------------                                         */
+/* This routine is used to switch to TestMode by re-     */
+/* initializing the l1a, l1s and l1a_l1s_com global      */
+/* structures. Re-initialization is kept at a minimum.   */
+/*-------------------------------------------------------*/
+void l1tm_initialize_var(void)
+{
+UWORD32 i;
+UWORD8  task_id;
+// L1S tasks management...
+//-----------------------------------------
+for(task_id=0; task_id<NBR_DL_L1S_TASKS; task_id++)
+{
+l1s.task_status[task_id].new_status     = NOT_PENDING;
+l1s.task_status[task_id].current_status = INACTIVE;
+}
+l1s.frame_count = 0;
+l1s.forbid_meas = 0;
+// MFTAB management variables...
+//-----------------------------------------
+l1s.afrm = 0;
+l1s_clear_mftab(l1s.mftab.frmlst);
+// Flag registers for RF task controle...
+//-----------------------------------------
+l1s.tpu_ctrl_reg = 0;
+l1s.dsp_ctrl_reg = 0;
+//++++++++++++++++++++++++++++++++++++++++++
+//  Reset "l1a" structure.
+//++++++++++++++++++++++++++++++++++++++++++
+// Downlink tasks management...
+// Uplink tasks management...
+// Measurement tasks management...
+//-----------------------------------------
+for(i=0; i<NBR_L1A_PROCESSES; i++)
+{
+l1a.l1a_en_meas[i] = 0;
+l1a.state[i]       = 0; // RESET state.
+}
+// Flag for forward/delete message management.
+//---------------------------------------------
+l1a.l1_msg_forwarded = 0;
+//++++++++++++++++++++++++++++++++++++++++++
+//  Reset "l1a_l1s_com" structure.
+//++++++++++++++++++++++++++++++++++++++++++
+l1a_l1s_com.l1a_activity_flag      = TRUE;
+l1a_l1s_com.time_to_next_l1s_task  = 0;
+// sleep management configuration
+//===============================
+l1s.pw_mgr.mode_authorized  = NO_SLEEP;
+// L1S scheduler...
+//====================
+// L1S tasks management...
+//-----------------------------------------
+for(i=0; i<NBR_DL_L1S_TASKS; i++)
+{
+l1a_l1s_com.task_param[i]  = SEMAPHORE_RESET;
+l1a_l1s_com.l1s_en_task[i] = TASK_DISABLED;
+}
+// Measurement tasks management...
+//-----------------------------------------
+l1a_l1s_com.meas_param  = 0;
+l1a_l1s_com.l1s_en_meas = 0;
+#if L1_GPRS
+// Set DSP scheduler mode
+l1a_l1s_com.dsp_scheduler_mode = GSM_SCHEDULER;
+//  Packet measurement: Reset of the frequency list.
+//-------------------------------------------------
+l1pa_reset_cr_freq_list();
+// Initialize active list used in Neighbour Measurement Transfer Process
+l1pa_l1ps_com.cres_freq_list.alist = &(l1pa_l1ps_com.cres_freq_list.list[0]);
+l1pa_l1ps_com.transfer.semaphore = TRUE;
+l1pa_l1ps_com.transfer.aset      = &(l1pa_l1ps_com.transfer.set[0]);
+l1pa_l1ps_com.transfer.fset[0]   = &(l1pa_l1ps_com.transfer.set[1]);
+l1pa_l1ps_com.transfer.fset[1]   = &(l1pa_l1ps_com.transfer.set[2]);
+for(i=0;i<3;i++)
+{
+l1pa_l1ps_com.transfer.set[i].SignalCode                   = 0;
+l1pa_l1ps_com.transfer.set[i].dl_tbf_synchro_timeslot      = 0;
+l1pa_l1ps_com.transfer.set[i].dl_tbf_synchro_timeslot      = 0;
+l1pa_l1ps_com.transfer.set[i].transfer_synchro_timeslot    = 0;
+l1pa_l1ps_com.transfer.set[i].allocated_tbf                = NO_TBF;
+l1pa_l1ps_com.transfer.set[i].assignment_command           = NO_TBF;
+l1pa_l1ps_com.transfer.set[i].multislot_class              = 0;
+l1pa_l1ps_com.transfer.set[i].packet_ta.ta                 = 255;
+l1pa_l1ps_com.transfer.set[i].packet_ta.ta_index           = 255;
+l1pa_l1ps_com.transfer.set[i].packet_ta.ta_tn              = 255;
+l1pa_l1ps_com.transfer.set[i].tsc                          = 0;
+l1pa_l1ps_com.transfer.set[i].freq_param.chan_sel.h        = 0;
+l1pa_l1ps_com.transfer.set[i].freq_param.chan_sel.
+rf_channel.single_rf.radio_freq = 0;
+l1pa_l1ps_com.transfer.set[i].tbf_sti.present              = FALSE;
+l1pa_l1ps_com.transfer.set[i].mac_mode                     = 0;
+l1pa_l1ps_com.transfer.set[i].ul_tbf_alloc->tfi            = 255;
+l1pa_l1ps_com.transfer.set[i].dl_tbf_alloc.tfi             = 255;
+l1pa_l1ps_com.transfer.set[i].dl_pwr_ctl.p0                = 255;
+l1pa_l1ps_com.transfer.set[i].dl_pwr_ctl.bts_pwr_ctl_mode  = 0;
+l1pa_l1ps_com.transfer.set[i].dl_pwr_ctl.pr_mode           = 0;
+}
+#endif
+// Init global test mode variables
+l1tm.tmode_state.dedicated_active = 0;
+#if L1_GPRS
+l1tm.tmode_state.packet_transfer_active = FALSE;
+#endif
+// PRBS seed initialization with a random pattern
+l1tm.tmode_prbs.prbs1_seed = 0x5613;
+}
+void l1tm_rf_enable(T_TESTMODE_PRIM *prim, T_TM_RETURN *tm_return)
+{
+unsigned SignalCode =0;
+unsigned size = 0;  //omaps00090550
+xSignalHeaderRec *msg;
+UWORD8 send_prim = FALSE;  // Flag to send TestMode primitive...
+// Do not send primitive is the default; change it if necessary
+UWORD8 band;
+tm_return->index = 0;      // don't include index in header
+#if (ETM_PROTOCOL == 1)
+tm_return->status = -ETM_OK;
+#else
+tm_return->status = E_OK;
+#endif
+// Function only valid in TEST mode
+if (l1_config.TestMode == 0)
+{
+#if (ETM_PROTOCOL == 1)
+tm_return->status = -ETM_L1TESTMODE;
+#else
+tm_return->status = E_TESTMODE;
+#endif
+}
+else
+{
+// Reset all statistics
+l1tm_reset_rx_stats();
+// Reset receive state counters, unless already in dedicated mode
+if (!l1tm.tmode_state.dedicated_active)
+l1tm_reset_rx_state();
+// Reset monitor task
+l1_config.tmode.rf_params.mon_report = 0;
+l1_config.tmode.rf_params.mon_tasks  = 0;
+switch (prim->u.tm_params.index)
+{
+// Stop all RX and TX operations
+case STOP_ALL:
+{
+SignalCode = TMODE_STOP_RX_TX;
+size = sizeof(T_TMODE_STOP_RX_TX);
+l1tm.tmode_state.dedicated_active = 0;
+#if (RF_FAM == 61)
+// Reset the APC back to Automatic Mode
+l1ddsp_apc_set_automatic_mode();
+#endif
+#if (RF_FAM == 35)
+pll_tuning.enable=0;
+#endif
+// Reset down_up flag only if not in continuous mode. If in continuous mode, down_up
+// will be reset after the proper TPU scenario is loaded.
+if (l1_config.tmode.rf_params.tmode_continuous != TM_CONTINUOUS)
+	  l1_config.tmode.rf_params.down_up = 0;
+send_prim = TRUE;
+break;
+}
+// RX with or without network synchronization first
+case RX_TCH:
+{
+// if already in UL-only
+if (l1tm.tmode_state.dedicated_active &&
+l1_config.tmode.rf_params.down_up == TMODE_UPLINK)
+{
+// cannot start to RX while already TXing
+#if (ETM_PROTOCOL == 1)
+tm_return->status = -ETM_AGAIN;
+#else
+tm_return->status = E_AGAIN;
+#endif
+}
+else
+{
+l1_config.tmode.rf_params.down_up = TMODE_DOWNLINK;
+SignalCode = TMODE_IMMED_ASSIGN_REQ;
+size = sizeof(T_TMODE_IMMED_ASSIGN_REQ);
+send_prim = TRUE;
+}
+break;
+}
+// TX NB's or AB's on TCH with or without network synch. first
+case TX_TCH:
+{
+// Normal burst TX
+if (l1_config.tmode.tx_params.burst_type == 0)
+{
+// if already in DL-only, add UL
+if (l1tm.tmode_state.dedicated_active &&
+l1_config.tmode.rf_params.down_up == TMODE_DOWNLINK)
+{
+l1_config.tmode.rf_params.down_up = (TMODE_DOWNLINK | TMODE_UPLINK);
+}
+else
+{
+l1_config.tmode.rf_params.down_up = TMODE_UPLINK;
+SignalCode = TMODE_IMMED_ASSIGN_REQ;
+size = sizeof(T_TMODE_IMMED_ASSIGN_REQ);
+send_prim = TRUE;
+}
+}
+// AB TX
+else if (l1_config.tmode.tx_params.burst_type == 1)
+{
+// cannot start RACH while already in dedicated mode
+if (l1tm.tmode_state.dedicated_active)
+{
+#if (ETM_PROTOCOL == 1)
+tm_return->status = -ETM_AGAIN;
+#else
+tm_return->status = E_AGAIN;
+#endif
+}
+else
+{
+SignalCode = TMODE_RA_START;
+size = sizeof(TMODE_RA_START);
+send_prim = TRUE;
+}
+}
+break;
+}
+// RX & TX on TCH with or without network synch. first
+case RX_TX_TCH:
+{
+// if NB TX
+if (l1_config.tmode.tx_params.burst_type == 0)
+{
+// if already in DL-only, add UL
+if (l1tm.tmode_state.dedicated_active &&
+l1_config.tmode.rf_params.down_up == TMODE_DOWNLINK)
+{
+l1_config.tmode.rf_params.down_up = (TMODE_DOWNLINK | TMODE_UPLINK);
+}
+// else if already in UL-only
+else if (l1tm.tmode_state.dedicated_active &&
+l1_config.tmode.rf_params.down_up == TMODE_UPLINK)
+{
+// cannot start to RX while already TXing
+#if (ETM_PROTOCOL == 1)
+tm_return->status = -ETM_AGAIN;
+#else
+tm_return->status = E_AGAIN;
+#endif
+}
+else
+{
+l1_config.tmode.rf_params.down_up = (TMODE_DOWNLINK | TMODE_UPLINK);
+SignalCode = TMODE_IMMED_ASSIGN_REQ;
+size = sizeof(T_TMODE_IMMED_ASSIGN_REQ);
+send_prim = TRUE;
+}
+}
+// else if AB TX
+else if (l1_config.tmode.tx_params.burst_type == 1)
+{
+// Cannot TX RACH and RX simultaneously
+#if (ETM_PROTOCOL == 1)
+tm_return->status = -ETM_AGAIN;
+#else
+tm_return->status = E_AGAIN;
+#endif
+}
+break;
+}
+// Continuous (all timeslots) reception on TCH
+case RX_TCH_CONT:
+{
+// if already in UL, DL or UL+DL
+if (l1tm.tmode_state.dedicated_active &&
+l1_config.tmode.rf_params.down_up != 0)
+{
+// cannot start to continously RX while already TXing or RXing
+#if (ETM_PROTOCOL == 1)
+tm_return->status = -ETM_AGAIN;
+#else
+tm_return->status = E_AGAIN;
+#endif
+}
+else
+{
+l1_config.tmode.rf_params.tmode_continuous = TM_START_RX_CONTINUOUS;
+l1_config.tmode.rf_params.down_up = TMODE_DOWNLINK;
+SignalCode = TMODE_IMMED_ASSIGN_REQ;
+size = sizeof(T_TMODE_IMMED_ASSIGN_REQ);
+send_prim = TRUE;
+}
+break;
+}
+// continuous (all timeslots) transmission
+case TX_TCH_CONT:
+{
+// PCS 1900 not supported yet.
+#if (L1_FF_MULTIBAND == 0)
+band = ((l1_config.tmode.rf_params.tch_arfcn >= 512) &&
+(l1_config.tmode.rf_params.tch_arfcn <= 885));
+#else
+band = ( ((l1_config.tmode.rf_params.tch_arfcn >= 512) &&
+(l1_config.tmode.rf_params.tch_arfcn <= 885)) ||
+((l1_config.tmode.rf_params.tch_arfcn >= 1024) &&
+(l1_config.tmode.rf_params.tch_arfcn <= 1322)) );
+#endif
+// if already in UL, DL or UL+DL
+if ((l1tm.tmode_state.dedicated_active && l1_config.tmode.rf_params.down_up != 0) ||
+(band == 0 && (l1_config.tmode.tx_params.txpwr < (5 + l1_config.tmode.tx_params.txpwr_skip)))  ||
+(band == 1 && (l1_config.tmode.tx_params.txpwr < (0 + l1_config.tmode.tx_params.txpwr_skip))))
+{
+// cannot start to continously TX while already TXing or RXing
+// or while adc reading are enabled
+#if (ETM_PROTOCOL == 1)
+tm_return->status = -ETM_INVAL;
+#else
+tm_return->status = E_INVAL;
+#endif
+}
+else
+{
+#if (RF_FAM == 61)
+// Set APC in Manual Mode
+l1ddsp_apc_set_manual_mode();
+#endif
+l1_config.tmode.rf_params.tmode_continuous = TM_START_TX_CONTINUOUS;
+l1_config.tmode.rf_params.down_up = TMODE_UPLINK;
+SignalCode = TMODE_IMMED_ASSIGN_REQ;
+size = sizeof(T_TMODE_IMMED_ASSIGN_REQ);
+send_prim = TRUE;
+}
+break;
+}
+// Continuous BCCH
+case BCCH_LOOP:
+{
+SignalCode = TMODE_SCELL_NBCCH_REQ;
+size = sizeof(TMODE_SCELL_NBCCH_REQ);
+send_prim = TRUE;
+break;
+}
+// Continuous SB
+case SB_LOOP:
+{
+SignalCode = TMODE_SB_REQ;
+size = sizeof(T_TMODE_SB_REQ);
+send_prim = TRUE;
+break;
+}
+// Continuous FB1
+case FB1_LOOP:
+{
+SignalCode = TMODE_FB1_REQ;
+size = sizeof(T_TMODE_FB1_REQ);
+send_prim = TRUE;
+break;
+}
+// Continuous FB0
+case FB0_LOOP:
+{
+SignalCode = TMODE_FB0_REQ;
+size = sizeof(T_TMODE_FB0_REQ);
+send_prim = TRUE;
+break;
+}
+// TX + RX + MON on TCH
+case RX_TX_MON_TCH: // Stats collected from TCH Channel.
+case RX_TX_MON:     // Stats collected from MON Channel (except rxlev).
+{
+// Normal burst uplink
+if (l1_config.tmode.tx_params.burst_type == 0)
+{
+// If already in dedicated mode, return error
+if (l1tm.tmode_state.dedicated_active)
+{
+#if (ETM_PROTOCOL == 1)
+tm_return->status = -ETM_AGAIN;
+#else
+tm_return->status = E_AGAIN;
+#endif
+}
+else
+{
+l1_config.tmode.rf_params.down_up = (TMODE_DOWNLINK | TMODE_UPLINK);
+l1_config.tmode.rf_params.mon_report = ((prim->u.tm_params.index & 0x08) >> 3);
+l1_config.tmode.rf_params.mon_tasks = 1;  // enable MON tasks
+SignalCode = TMODE_IMMED_ASSIGN_REQ;
+size = sizeof(T_TMODE_IMMED_ASSIGN_REQ);
+send_prim = TRUE;
+}
+}
+// else if Access burst uplink
+else if (l1_config.tmode.tx_params.burst_type == 1)
+{
+// Cannot TX RACH and RX simultaneously
+#if (ETM_PROTOCOL == 1)
+tm_return->status = -ETM_AGAIN;
+#else
+tm_return->status = E_AGAIN;
+#endif
+}
+break;
+}
+case SINGLE_PM:
+{
+SignalCode = TMODE_RXLEV_REQ;
+size = sizeof(T_TMODE_RXLEV_REQ);
+send_prim = TRUE;
+break;
+}
+#if L1_GPRS
+// RX & TX on PDTCH with or without network synch. first
+case RX_TX_PDTCH:
+{
+UWORD8 bit_map = 0x80;
+// set uplink + downlink
+if (l1_config.tmode.tx_params.timeslot_alloc)
+l1_config.tmode.rf_params.down_up = TMODE_DOWNLINK | TMODE_UPLINK;
+else
+l1_config.tmode.rf_params.down_up = TMODE_DOWNLINK;
+while (bit_map)
+{
+if (bit_map & l1_config.tmode.stats_config.stat_gprs_slots)
+l1tm.tmode_stats.nb_dl_pdtch_slots ++;
+bit_map>>=1;
+}
+SignalCode = TMODE_PDTCH_ASSIGN_REQ;
+size = sizeof(T_TMODE_PDTCH_ASSIGN_REQ);
+send_prim = TRUE;
+break;
+}
+#endif
+#if L1_GPRS
+// RX & TX on PDTCH, FB on monitor arfcn
+case RX_TX_PDTCH_MON:
+{
+// set uplink + downlink
+if (l1_config.tmode.tx_params.timeslot_alloc)
+l1_config.tmode.rf_params.down_up = TMODE_DOWNLINK | TMODE_UPLINK;
+else
+l1_config.tmode.rf_params.down_up = TMODE_DOWNLINK;
+l1_config.tmode.rf_params.mon_report = 1;  // collect stats from MON channel
+l1_config.tmode.rf_params.mon_tasks  = 1;  // enable MON tasks
+SignalCode = TMODE_PDTCH_ASSIGN_REQ;
+size = sizeof(T_TMODE_PDTCH_ASSIGN_REQ);
+send_prim = TRUE;
+break;
+}
+#endif
+#if (RF_FAM == 35)
+case RX_PLL_TUNING:
+{
+// if already in UL-only
+if (l1tm.tmode_state.dedicated_active &&
+l1_config.tmode.rf_params.down_up == TMODE_UPLINK)
+{
+// cannot start to RX while already TXing
+#if (ETM_PROTOCOL == 1)
+tm_return->status = -ETM_AGAIN;
+#else
+tm_return->status = E_AGAIN;
+#endif
+}
+else
+{
+pll_tuning.data[5]   = 0;
+pll_tuning.index     = 0;
+pll_tuning.enable    = 1;
+l1_config.tmode.rf_params.down_up = TMODE_DOWNLINK;
+SignalCode = TMODE_IMMED_ASSIGN_REQ;
+size = sizeof(T_TMODE_IMMED_ASSIGN_REQ);
+send_prim = TRUE;
+}
+break;
+}
+#endif
+default:
+{
+#if (ETM_PROTOCOL == 1)
+tm_return->status = -ETM_INVAL;
+#else
+tm_return->status = E_BADINDEX;
+#endif
+break;
+}
+} //end switch
+} // end of else
+if (send_prim == TRUE)
+{
+// Allocate result message.
+msg = os_alloc_sig(size);
+DEBUGMSG(status,NU_ALLOC_ERR)
+msg->SignalCode = SignalCode;
+os_send_sig(msg, L1C1_QUEUE);
+DEBUGMSG(status,NU_SEND_QUEUE_ERR)
+}
+// always return a 0 in the result[], even if error
+tm_return->result[0] = 0;
+tm_return->size =  1;
+}
+void l1tm_stats_config_write(T_TESTMODE_PRIM *prim, T_TM_RETURN *tm_return)
+{
+tm_return->index = prim->u.tm_params.index;
+tm_return->size = 0;
+switch (prim->u.tm_params.index)
+{
+case LOOPS:
+{
+l1_config.tmode.stats_config.num_loops = prim->u.tm_params.value;
+#if (ETM_PROTOCOL == 1)
+tm_return->status = -ETM_OK;
+#else
+tm_return->status = E_OK;
+#endif
+break;
+}
+case AUTO_RESULT_LOOPS:
+{
+l1_config.tmode.stats_config.auto_result_loops = prim->u.tm_params.value;
+#if (ETM_PROTOCOL == 1)
+tm_return->status = -ETM_OK;
+#else
+tm_return->status = E_OK;
+#endif
+break;
+}
+case AUTO_RESET_LOOPS:
+{
+l1_config.tmode.stats_config.auto_reset_loops = prim->u.tm_params.value;
+#if (ETM_PROTOCOL == 1)
+tm_return->status = -ETM_OK;
+#else
+tm_return->status = E_OK;
+#endif
+break;
+}
+case STAT_TYPE:
+{
+l1_config.tmode.stats_config.stat_type = prim->u.tm_params.value;
+#if (ETM_PROTOCOL == 1)
+tm_return->status = -ETM_OK;
+#else
+tm_return->status = E_OK;
+#endif
+break;
+}
+case STAT_BITMASK:
+{
+l1_config.tmode.stats_config.stat_bitmask = prim->u.tm_params.value;
+#if (ETM_PROTOCOL == 1)
+tm_return->status = -ETM_OK;
+#else
+tm_return->status = E_OK;
+#endif
+break;
+}
+#if L1_GPRS
+case STAT_GPRS_SLOTS:
+{
+UWORD8 allocation, value;
+value = prim->u.tm_params.value;
+// Check for mismatch between DL TS allocation and stats bitmap
+allocation = value ^ l1_config.tmode.rx_params.timeslot_alloc;
+if (value & allocation)
+#if (ETM_PROTOCOL == 1)
+tm_return->status = -ETM_INVAL;
+#else
+tm_return->status = E_INVAL;
+#endif
+else
+{
+l1_config.tmode.stats_config.stat_gprs_slots = value;
+#if (ETM_PROTOCOL == 1)
+tm_return->status = -ETM_OK;
+#else
+tm_return->status = E_OK;
+#endif
+}
+break;
+}
+#endif
+default:
+{
+#if (ETM_PROTOCOL == 1)
+tm_return->status = -ETM_INVAL;
+#else
+tm_return->status = E_BADINDEX;
+#endif
+break;
+}
+}  // end switch
+}
+void l1tm_stats_config_read(T_TESTMODE_PRIM *prim, T_TM_RETURN *tm_return)
+{
+volatile UWORD16 value;
+tm_return->index = prim->u.tm_params.index;
+switch (prim->u.tm_params.index)
+{
+case LOOPS:
+{
+value = l1_config.tmode.stats_config.num_loops;
+break;
+}
+case AUTO_RESULT_LOOPS:
+{
+value = l1_config.tmode.stats_config.auto_result_loops;
+break;
+}
+case AUTO_RESET_LOOPS:
+{
+value = l1_config.tmode.stats_config.auto_reset_loops;
+break;
+}
+case STAT_TYPE:
+{
+value = l1_config.tmode.stats_config.stat_type;
+break;
+}
+case STAT_BITMASK:
+{
+value = l1_config.tmode.stats_config.stat_bitmask;
+break;
+}
+#if L1_GPRS
+case STAT_GPRS_SLOTS:
+{
+value = l1_config.tmode.stats_config.stat_gprs_slots;
+break;
+}
+#endif
+default:
+{
+#if (ETM_PROTOCOL == 1)
+tm_return->status = -ETM_INVAL;
+#else
+tm_return->status = E_BADINDEX;
+#endif
+tm_return->size = 0;
+return;
+}
+}  // end switch
+memcpy(tm_return->result, (UWORD8 *) &value, 2);
+tm_return->size = 2;
+#if (ETM_PROTOCOL == 1)
+tm_return->status = -ETM_OK;
+#else
+tm_return->status = E_OK;
+#endif
+}
+void l1tm_statistics(T_TESTMODE_PRIM *prim, T_TM_RETURN *tm_return)
+{
+l1tm_stats_read(tm_return,
+prim->u.tm_params.index,
+prim->u.tm_params.value);
+}
+#if L1_GPRS
+void l1tm_rlc_uplink(UWORD8 tx, API *ul_data)
+{
+// Cast the ul_data_buffer
+typedef struct
+{
+API a_ul_data[4][29];
+}
+T_A_UL_DATA;
+T_A_UL_DATA *ptr = (T_A_UL_DATA*) ul_data;
+UWORD8 i,j;
+for (j=0; j<tx; j++)
+{
+ptr->a_ul_data[j][0] = l1_config.tmode.tx_params.coding_scheme;
+for (i=0;i<l1_config.tmode.tx_params.rlc_buffer_size;i++)
+ptr->a_ul_data[j][i+1] = l1_config.tmode.tx_params.rlc_buffer[i];
+}
+}
+#endif
+void l1tm_stats_read(T_TM_RETURN *tm_return, WORD16 type, UWORD16 bitmask)
+{
+extern T_L1A_L1S_COM l1a_l1s_com;
+extern T_L1S_GLOBAL l1s;
+volatile UWORD32 utemp = bitmask, temp_U32;
+volatile WORD32  temp = type;
+volatile WORD32  value_signed_int;
+volatile UWORD32 value_unsigned_int;
+volatile UWORD16 value_unsigned_short;
+UWORD8  j, offset=0;  // offset is index of tm_return->result[]
+UWORD16 rssi, len;
+WORD32  count;
+WORD32  runs = l1tm.tmode_stats.loop_count;
+/*
+* FreeCalypso TCS211 reconstruction: the following automatic var
+* is for the BLER code we have conditioned out below.
+*/
+#if 0 //L1_GPRS
+volatile UWORD16 value_array_unsigned_short[4];
+#endif
+// Put type and bitmask in the front of tm_return->result[].
+// Use volatile vars for proper operation of memcpy().
+memcpy(&tm_return->result[offset], (UWORD8 *) &temp, 2);
+offset+=2;
+memcpy(&tm_return->result[offset], (UWORD8 *) &utemp, 2);
+offset+=2;
+switch (type)
+{
+// Accumulated receive burst stats
+case ACCUMULATED_RX_STATS:
+{
+// all stats saved when collected from TCH
+if (l1tm.tmode_state.dedicated_active && (l1_config.tmode.rf_params.mon_report == 0))
+count = l1tm.tmode_stats.loop_count;
+#if L1_GPRS
+else if (l1tm.tmode_state.packet_transfer_active && (l1_config.tmode.rf_params.mon_report == 0))
+{
+// loop_count contains the number of blocks
+// Stats (PM, TOA, SNR, ANGLE) are accumulated over all frames and all time slots
+count = l1tm.tmode_stats.loop_count * l1tm.tmode_stats.nb_dl_pdtch_slots * 4;
+// the count of runs vs. successes is accumulated over all time slots per block
+runs  = l1tm.tmode_stats.loop_count * l1tm.tmode_stats.nb_dl_pdtch_slots;
+}
+#endif
+else count = l1tm.tmode_stats.flag_count; // only PASS stats saved
+if (bitmask & RSSI) // rxlev: RSSI SF12.4 eventually (currently F7.1)
+{
+len = sizeof(l1tm.tmode_stats.rssi_fifo) / sizeof(l1tm.tmode_stats.rssi_fifo[0]);
+rssi = 0;
+for (j=0; j<len; j++)
+rssi += l1tm.tmode_stats.rssi_fifo[j];
+rssi /= len; // F7.1
+memcpy(&tm_return->result[offset], (UWORD8 *) &rssi, 2);
+offset+=2;
+}
+// pm: DSP MEAN power measurement UF10.6
+if (bitmask & DSP_PM)
+{
+if (count)
+value_unsigned_short = l1tm.tmode_stats.pm_sum / count;
+else value_unsigned_short = 0;
+memcpy(&tm_return->result[offset], (UWORD8 *) &value_unsigned_short, 2);
+offset+=2;
+}
+// angle mean
+if (bitmask & ANGLE_MEAN)
+{
+if (count) // non-zero
+value_signed_int = l1tm.tmode_stats.angle_sum / count;
+else value_signed_int = 0;
+memcpy(&tm_return->result[offset], (UWORD8 *) &value_signed_int, 4);
+offset+=4;
+}
+// angle variance
+if (bitmask & ANGLE_VAR)
+{
+// VAR[X] = E[X^2] - (E[X])^2
+if (count) // non-zero
+{
+temp_U32 = l1tm.tmode_stats.angle_sum / count;
+value_unsigned_int = l1tm.tmode_stats.angle_sq_sum / count - (temp_U32)*(temp_U32);
+}
+else value_unsigned_int = 0;
+memcpy(&tm_return->result[offset], (UWORD8 *) &value_unsigned_int, 4);
+offset+=4;
+}
+// angle minimum
+if (bitmask & ANGLE_MIN)
+{
+value_signed_int = l1tm.tmode_stats.angle_min;
+memcpy(&tm_return->result[offset], (UWORD8 *) &value_signed_int, 4);
+offset+=4;
+}
+// angle maximum
+if (bitmask & ANGLE_MAX)
+{
+value_signed_int = l1tm.tmode_stats.angle_max;
+memcpy(&tm_return->result[offset], (UWORD8 *) &value_signed_int, 4);
+offset+=4;
+}
+// SNR mean
+if (bitmask & SNR_MEAN)
+{
+if (count) // non-zero
+value_unsigned_int = l1tm.tmode_stats.snr_sum / count;
+else value_unsigned_int = 0;
+memcpy(&tm_return->result[offset], (UWORD8 *) &value_unsigned_int, 4);
+offset+=4;
+}
+// SNR variance
+if (bitmask & SNR_VAR)
+{
+if (count) // non-zero
+{
+temp_U32 = l1tm.tmode_stats.snr_sum / count;
+value_unsigned_int = l1tm.tmode_stats.snr_sq_sum / count -
+temp_U32 * temp_U32;
+}
+else
+value_unsigned_int = 0;
+memcpy(&tm_return->result[offset], (UWORD8 *) &value_unsigned_int, 4);
+offset+=4;
+}
+// TOA mean
+if (bitmask & TOA_MEAN)
+{
+if (count) // non-zero
+value_unsigned_int = l1tm.tmode_stats.toa_sum / count;
+else value_unsigned_int = 0;
+memcpy(&tm_return->result[offset], (UWORD8 *) &value_unsigned_int, 4);
+offset+=4;
+}
+// TOA variance
+if (bitmask & TOA_VAR)
+{
+if (count) // non-zero
+{
+temp_U32 = l1tm.tmode_stats.toa_sum / count;
+value_unsigned_int = l1tm.tmode_stats.toa_sq_sum / count -
+temp_U32 * temp_U32;
+}
+else value_unsigned_int = 0;
+memcpy(&tm_return->result[offset], (UWORD8 *) &value_unsigned_int, 4);
+offset+=4;
+}
+// Frame # mod 26*51
+if (bitmask & FRAME_NUMBER)
+{
+value_unsigned_int = l1s.actual_time.fn;
+memcpy(&tm_return->result[offset], (UWORD8 *) &value_unsigned_int, 4);
+offset+=4;
+}
+// Tot # of runs executed so far
+if (bitmask & RUNS)
+{
+memcpy(&tm_return->result[offset], (UWORD8 *) &runs, 4);
+offset+=4;
+}
+// Tot # of successes so far
+if (bitmask & SUCCESSES)
+{
+memcpy(&tm_return->result[offset], (UWORD8 *) &l1tm.tmode_stats.flag_count, 4);
+offset+=4;
+}
+// BSIC
+if (bitmask & BSIC)
+{
+value_unsigned_short = l1tm.tmode_stats.bsic;
+memcpy(&tm_return->result[offset], (UWORD8 *) &value_unsigned_short, 2);
+offset+=2;
+}
+/*
+* FreeCalypso TCS211 reconstruction: suspected LoCosto-ism,
+* removing in order to pass compilation.
+*/
+#if 0 //L1_GPRS
+if (bitmask & BLER)
+{
+UWORD8 j;
+if (count) // non-zero
+{
+float bler, remain_part;
+UWORD8  int_part, bitmap_remain;
+int i;
+//compute bler for each block
+for (j=0; j<4; j++)
+{
+bler = ((float) (l1tm.tmode_stats.bler_crc[j] * 100)) / ((float) l1tm.tmode_stats.bler_total_blocks);
+//conversion from floating to fixed format
+int_part = (UWORD8) bler;
+remain_part = bler - (float) int_part;
+bitmap_remain = 0;
+i=5;
+while (i >= 0)
+{
+bitmap_remain |= (UWORD8) (remain_part *2) << i;
+if (((UWORD8) (remain_part *2)) >= 1)
+remain_part = (remain_part * 2) - 1;
+else
+remain_part = (remain_part * 2);
+i--;
+}
+// Reporting the percentage of blocks in error (F10.6)
+value_array_unsigned_short[j] = bitmap_remain | (int_part << 6);
+}
+}
+// Reporting a BLER of 100, if no computation has been done
+else
+{
+for (j=0; j<4; j++)
+value_array_unsigned_short[j] = 100 << 6;
+}
+memcpy(&tm_return->result[offset], (UWORD8 *) &value_array_unsigned_short[0], 8);
+offset+=8;
+	}
+#endif
+#if (ETM_PROTOCOL == 1)
+tm_return->status = -ETM_OK;
+#else
+tm_return->status = E_OK;
+#endif
+break;
+}
+// Most recent receive burst stats
+case MOST_RECENT_RX_STATS:
+{
+// rxlev: RSSI SF12.4 eventually (F7.1 currently)
+if (bitmask & RSSI)
+{
+value_unsigned_short = l1tm.tmode_stats.rssi_recent;
+memcpy(&tm_return->result[offset], (UWORD8 *) &value_unsigned_short, 2);
+offset+=2;
+}
+// pm: most recent DSP power measurement UF10.6
+if (bitmask & DSP_PM)
+{
+memcpy(&tm_return->result[offset], &l1tm.tmode_stats.pm_recent, 2);
+offset+=2;
+}
+// most recent ANGLE value
+if (bitmask & ANGLE_MEAN)
+{
+value_signed_int = l1tm.tmode_stats.angle_recent;
+memcpy(&tm_return->result[offset], (UWORD8 *) &value_signed_int, 4);
+offset+=4;
+}
+// doesn't make sense.
+if (bitmask & ANGLE_VAR)
+{
+}
+// doesn't make sense.
+if (bitmask & ANGLE_MIN)
+{
+}
+// doesn't make sense.
+if (bitmask & ANGLE_MAX)
+{
+}
+// most recent SNR value
+if (bitmask & SNR_MEAN)
+{
+value_unsigned_int = l1tm.tmode_stats.snr_recent;
+memcpy(&tm_return->result[offset], (UWORD8 *) &value_unsigned_int, 4);
+offset+=4;
+}
+// doesn't make sense.
+if (bitmask & SNR_VAR)
+{
+}
+// most recent TOA value
+if (bitmask & TOA_MEAN)
+{
+value_unsigned_int = l1tm.tmode_stats.toa_recent;
+memcpy(&tm_return->result[offset], (UWORD8 *) &value_unsigned_int, 4);
+offset+=4;
+}
+// doesn't make sense.
+if (bitmask & TOA_VAR)
+{
+}
+// Frame # mod 26*51
+if (bitmask & FRAME_NUMBER)
+{
+value_unsigned_int = l1s.actual_time.fn;
+memcpy(&tm_return->result[offset], (UWORD8 *) &value_unsigned_int, 4);
+offset+=4;
+}
+// must be '1'
+if (bitmask & RUNS)
+{
+}
+// most recent Success flag
+if (bitmask & SUCCESSES)
+{
+memcpy(&tm_return->result[offset], (UWORD8 *)&l1tm.tmode_stats.flag_recent, 4);
+offset+=4;
+}
+// BSIC
+if (bitmask & BSIC)
+{
+value_unsigned_short = l1tm.tmode_stats.bsic;
+memcpy(&tm_return->result[offset], (UWORD8 *) &value_unsigned_short, 2);
+offset+=2;
+}
+#if (ETM_PROTOCOL == 1)
+tm_return->status = -ETM_OK;
+#else
+tm_return->status = E_OK;
+#endif
+break;
+}
+default:
+{
+#if (ETM_PROTOCOL == 1)
+tm_return->status = -ETM_INVAL;
+#else
+tm_return->status = E_BADINDEX;
+#endif
+break;
+}
+}  // end switch
+tm_return->size = offset;
+tm_return->index = 0;  // don't include index in header
+}
+/*-------------------------------------------------------*/
+/* l1tm_fill_burst()                                     */
+/*-------------------------------------------------------*/
+/*                                                       */
+/* Description:  Prepare bursts for transmission in case */
+/* ------------  of UL test                              */
+/*                                                       */
+/* Simulation of IQ Swap does the following mapping:     */
+/*                                                       */
+/*             00 -> 01                                  */
+/*             01 -> 00                                  */
+/*             10 -> 11                                  */
+/*             11 -> 10                                  */
+/*                                                       */
+/*-------------------------------------------------------*/
+#if (L1_FF_MULTIBAND == 1)
+extern const WORD8 rf_subband2band[];
+#endif
+void l1tm_fill_burst (UWORD16 pattern, UWORD16 *TM_ul_data)
+{
+UWORD32 i;
+UWORD8  swap_iq, swap_flag;
+UWORD16 gb_front, gb_end, tb_front, tb_end, even_bits, odd_bits;
+#if (L1_FF_MULTIBAND == 1)
+UWORD8 physical_band_id;
+#endif
+UWORD8 tsc_bits_in_first_word;
+UWORD16 tsc_front_mask,tsc_end_mask;
+extern  T_RF rf;
+// training sequences list......
+UWORD32 tsc[8]=
+{
+0x00970897,
+0x00B778B7,
+0x010EE90E,
+0x011ED11E,
+0x006B906B,
+0x013AC13A,
+0x029F629F,
+0x03BC4BBC
+};
+#if (L1_FF_MULTIBAND == 0)
+if(((l1_config.std.id == DUAL) || (l1_config.std.id == DUALEXT) || (l1_config.std.id == DUAL_US)) &&
+(l1_config.tmode.rf_params.tch_arfcn >= l1_config.std.first_radio_freq_band2))
+{
+swap_iq = l1_config.std.swap_iq_band2;
+}
+else
+{
+swap_iq = l1_config.std.swap_iq_band1;
+}
+#else // L1_FF_MULTIBAND = 1 below
+physical_band_id =
+rf_subband2band[rf_convert_rffreq_to_l1subband(l1_config.tmode.rf_params.tch_arfcn)];
+swap_iq = rf_band[physical_band_id].swap_iq;
+#endif // #if (L1_FF_MULTIBAND == 0) else
+// Swap IQ definitions...
+// 0=No Swap, 1=Swap RX only, 2=Swap TX only, 3=Swap RX and TX
+if (swap_iq & 0x2)
+{
+swap_flag = 1;
+}
+else
+{
+swap_flag = 0;
+}
+//===========================================
+// define uplink patterns
+//===========================================
+if (pattern == 0)       //  0's
+pattern = 0x0000;
+else if (pattern == 1)  //  1's
+pattern = 0xffff;
+else if (pattern == 2)  // 01's
+pattern = 0x5555;
+// first replicate pattern through all buffer
+if ((pattern == 3) || (pattern == 4))
+{
+// fill the uplink burst with PRBS1
+l1tm_PRBS1_generate(TM_ul_data);
+}
+else if ((pattern != 12) && (pattern != 13))
+{
+for (i=0;i<=15;i++)
+TM_ul_data[i] = (pattern << 6);
+}
+//===========================================
+// create front-end guard and tail bits masks
+//===========================================
+// guard bits mask
+gb_front = 0xFFC0 << (10 - rf.tx.guard_bits);  // max. of 10, min. of 2 guard bits allowed
+// check if guard bits > 7
+if (rf.tx.guard_bits > 7)
+{
+// tail bits mask
+tb_front = ~((UWORD16)(0xE000 << (10 - rf.tx.guard_bits))) & 0xFFC0;  // tail bits placed in TM_ul_data[1]  //oamps00090550
+// add tail bits to uplink data
+TM_ul_data[1] = TM_ul_data[1] & tb_front;
+// add guard bits to uplink data
+TM_ul_data[0] = gb_front;
+}
+else
+{
+// tail bits mask
+tb_front = ~((UWORD16)(0xE000 >> rf.tx.guard_bits) )& 0xFFC0;  // 3 tail bits
+// add tail bits to uplink data
+TM_ul_data[0] = (TM_ul_data[0] | gb_front) & tb_front;
+}
+//===========================================
+// create back-end guard and tail bits masks
+//===========================================
+// guard bits mask
+gb_end = (0xFFC0 >> (10 - (12 - rf.tx.guard_bits))) & 0xFFC0;  // max. of 10, min. of 2 guard bits allowed
+// check if guard bits < 5
+if (rf.tx.guard_bits < 5)
+{
+//tail bits mask
+tb_end = ~(UWORD16)((0x01C0 >> (rf.tx.guard_bits - 2))) & 0xFFC0;  // tail bits placed in TM_ul_data[14]
+// add tail bits to uplink data
+TM_ul_data[14] = TM_ul_data[14] & tb_end;
+// add guard bits to uplink data
+TM_ul_data[15] = gb_end;
+}
+else
+{
+// tail bits mask
+tb_end = ~(UWORD16)((0x01C0 << (12 - rf.tx.guard_bits))) & 0xFFC0;  // 3 tail bits
+// add tail bits to uplink data
+TM_ul_data[15] = (TM_ul_data[15] | gb_end) & tb_end;
+}
+//===========================================
+// Insert the training sequence pattern .The location of TSC bits will
+// vary according to the value of guard bits used.
+//===========================================
+if ((pattern == 13)||(pattern==3))
+{
+//   TM_ul_data[6]  = (TM_ul_data[6]  & 0xFE00) | ( (UWORD8) ((tsc[l1_config.tmode.tx_params.tsc]>>24) << 6 ) );   // tsc bits 1-2
+//    TM_ul_data[7]  = (TM_ul_data[7]  & 0x0000) | ( (UWORD8) ((tsc[l1_config.tmode.tx_params.tsc]>>14) << 6 ) );   // tsc bits 3-12
+//   TM_ul_data[8]  = (TM_ul_data[8]  & 0x0000) | ( (UWORD8) ((tsc[l1_config.tmode.tx_params.tsc]>>4 ) << 6 ) );   // tsc bits 13-22
+//   TM_ul_data[9]  = (TM_ul_data[9]  & 0x07C0) | ( (UWORD8) ((tsc[l1_config.tmode.tx_params.tsc]>>0 ) << 12) );   // tsc bits 23-26
+if (rf.tx.guard_bits <4) // TSC will be in [6],[7],[8]
+{
+tsc_bits_in_first_word = 9-rf.tx.guard_bits; // 7 bits when guard is 2, 6 bit when guard is 3
+tsc_front_mask = ((0xFFC0) << tsc_bits_in_first_word); // insert zeros from right
+//tsc_bits_in_last_word = 26 -10 -tsc_bits_in_first_word = (16-tsc_bits_in_first_word)
+tsc_end_mask =  (((0xFFC0) >> (16-tsc_bits_in_first_word)) & 0xFFC0);   //insert zeros from left
+TM_ul_data[6]  = (TM_ul_data[6]  & tsc_front_mask)
+| ( ((UWORD16) ((tsc[l1_config.tmode.tx_params.tsc]>>(26-tsc_bits_in_first_word)) << 6 )) & (~tsc_front_mask) );
+TM_ul_data[7]  = (TM_ul_data[7]  & 0x0000)
+| ( ((UWORD16) ((tsc[l1_config.tmode.tx_params.tsc]<<(tsc_bits_in_first_word+6))>>16)) & (0xFFC0));   //next 10 bits of TSC
+TM_ul_data[8]  = (TM_ul_data[8]  & tsc_end_mask)
+| ( ((UWORD16) ((tsc[l1_config.tmode.tx_params.tsc] << (tsc_bits_in_first_word+6+10))>>16) )& (~tsc_end_mask));
+}
+else if ((rf.tx.guard_bits >=4) && (rf.tx.guard_bits <9) )// TSC will be in [6],[7],[8],[9]
+{
+tsc_bits_in_first_word = 9-rf.tx.guard_bits; // 5 bits when guard is 4, 1 bit when guard is 8
+tsc_front_mask = ((0xFFC0) << tsc_bits_in_first_word); // insert zeros from right
+//tsc_bits_in_last_word = 26 -10 -10 -tsc_bits_in_first_word = (6-tsc_bits_in_first_word)
+tsc_end_mask =  (((0xFFC0) >> (6-tsc_bits_in_first_word)) & 0xFFC0);   //insert zeros from left
+TM_ul_data[6]  = (TM_ul_data[6]  & tsc_front_mask)
+| ( ((UWORD16) ((tsc[l1_config.tmode.tx_params.tsc]>>(26-tsc_bits_in_first_word)) << 6 )) & (~tsc_front_mask) );
+TM_ul_data[7]  = (TM_ul_data[7]  & 0x0000)
+| ( ((UWORD16) ((tsc[l1_config.tmode.tx_params.tsc]<<(tsc_bits_in_first_word+6))>>16)) & (0xFFC0)  );   //next 10 bits of TSC
+TM_ul_data[8]  = (TM_ul_data[8]  & 0x0000)
+| ( ((UWORD16) ((tsc[l1_config.tmode.tx_params.tsc]<<(tsc_bits_in_first_word+6+10))>>16)) & (0xFFC0) );   //next 10 bits of TSC
+TM_ul_data[9]  = (TM_ul_data[9]  & tsc_end_mask)
+| ( ((UWORD16) ((tsc[l1_config.tmode.tx_params.tsc] << (tsc_bits_in_first_word+6+10+10))>>16) ) & (~tsc_end_mask));
+}
+else   //(rf.tx.guard_bits>=9) : TSC will be in [7],[8],[9],
+{
+tsc_bits_in_first_word = 19-rf.tx.guard_bits; // 10 bits when guard is 9, 9 bits when guard is 10
+tsc_front_mask = ((0xFFC0) << tsc_bits_in_first_word); // insert zeros from right
+//tsc_bits_in_last_word = 26 -10 -tsc_bits_in_first_word = (16-tsc_bits_in_first_word)
+tsc_end_mask =  (((0xFFC0) >> (16-tsc_bits_in_first_word)) & 0xFFC0);   //insert zeros from left
+TM_ul_data[7]  = (TM_ul_data[7]  & tsc_front_mask)
+| ( ((UWORD16) ((tsc[l1_config.tmode.tx_params.tsc]>>(26-tsc_bits_in_first_word)) << 6 )) & (~tsc_front_mask) );
+TM_ul_data[8]  = (TM_ul_data[8]  & 0x0000)
+| ( ((UWORD16) ((tsc[l1_config.tmode.tx_params.tsc]<<(tsc_bits_in_first_word+6))>>16)) & (0xFFC0)  );   //next 10 bits of TSC
+TM_ul_data[9]  = (TM_ul_data[9]  & tsc_end_mask)
+| ( ((UWORD16) ((tsc[l1_config.tmode.tx_params.tsc] << (tsc_bits_in_first_word+6+10))>>16)) & (~tsc_end_mask));
+}
+}
+// swap uplink data if IQ swap
+if(swap_flag)
+{
+for (i=0;i<=15;i++)
+{
+even_bits = TM_ul_data[i] & 0xAA80;  // keep bits in even positions
+odd_bits  = ~(TM_ul_data[i]) & 0x5540;  // keep and complement bits in odd positions
+TM_ul_data[i] = even_bits | odd_bits;  // swapped uplink data
+}
+}
+}
+void l1a_tmode_send_ul_msg(T_TM_RETURN *tm_ret)
+{
+tm_transmit(tm_ret);
+}
+/*******************************************************************************
+*
+*                             void tm_receive(void *inbuf, int size)
+*
+* Purpose  : Parses TestMode data and copies it directly into TESTMODE_PRIM.
+*            It forwards primitive to L1, except in the case of tm_init() which
+*            gets executed in the CST.
+*
+* Arguments: In : command
+*            Out:
+*
+* Returns  : void
+*
+******************************************************************************/
+void tm_receive(UWORD8 *inbuf, UWORD16 size)
+{
+UWORD8 cksum, cid, error = 0;
+BOOL msg_used=FALSE;
+#if (ETM_PROTOCOL == 1)
+UWORD8 mid = 0;
+#endif
+UWORD8 *pmsg;
+xSignalHeaderRec *msg;
+msg = os_alloc_sig(sizeof(T_TESTMODE_PRIM));
+msg->SignalCode = TESTMODE_PRIM;
+// pmsg will be used to fill up the TestMode primitive with th
+// data, in consecutive order according to the definition of T_TESTMODE_PRIM.
+pmsg = (UWORD8 *)((T_TESTMODE_PRIM *)(msg->SigP));
+#if (ETM_PROTOCOL == 1) // Use of ETM protocol
+#if (OP_L1_STANDALONE == 1)
+// Check MID
+*pmsg++ = mid = *inbuf++;
+if ((mid != ETM_RF) && (mid != ETM_CORE))    // check if coming from ETM RF or ETM CORE DLL
+error = -ETM_PACKET;
+#elif (OP_L1_STANDALONE == 0)
+*pmsg++ = mid = ETM_RF;
+#endif
+// Copy CID/FID
+*pmsg++ = cid = *inbuf++;
+#if (OP_L1_STANDALONE == 1)
+// Copy data payload size (size minus MID byte and checksum byte)
+size -= 2;
+#endif
+*pmsg++ = --size; // Size of TM payload -1 for cid/fid
+// Validate data payload size: check if longer than size of testmode
+// primitive minus cid, str_len_in_bytes, and two holes FIXME: This is a
+// really bad way of doing it!
+if (size > sizeof(T_TESTMODE_PRIM) - 4)
+error = -ETM_PACKET;
+// The CID have been received. The data that follows are part of a
+// unique struct within the union of T_TESTMODE_PRIM, so we now
+// need to align at a 32-bit word boundary.
+*pmsg++ = 0;
+// In a SSA integration the cksum is done in the etm_receive function
+#if (OP_L1_STANDALONE == 1)
+if (!error)
+{
+cksum   = mid;
+cksum  ^= cid;
+while (size--)
+{
+cksum  ^= *inbuf;
+*pmsg++ = *inbuf++;
+}
+if (cksum != *inbuf)
+error = -ETM_PACKET;
+}
+#elif (OP_L1_STANDALONE == 0)
+// Copy payload without cid/fid
+while (size--)
+{
+*pmsg++ = *inbuf++;
+}
+#endif
+// At this point, all the data have been parsed and copied into
+// the TestMode primitive.  Now we send the primitive to L1.
+if (!error)
+{
+os_send_sig(msg, L1C1_QUEUE);
+msg_used=TRUE;
+}
+else
+{
+UWORD8 mymsg[4];
+// on error, return short error message; cid, error, checksum
+mymsg[0] = mid;
+mymsg[1] = cid;         // the payload fid
+mymsg[2] = error;       // status
+mymsg[3] = cid ^ error; // checksum
+#if (TRACE_TYPE==0) || (TRACE_TYPE==1) || (TRACE_TYPE==4) || (TRACE_TYPE==7)
+rvt_send_trace_cpy((T_RVT_BUFFER) mymsg,
+tm_trace_user_id,
+4,
+RVT_BINARY_FORMAT);
+#endif
+}
+#else // end of (ETM_PROTOCOL ==1)
+// Copy CID
+*pmsg++ = cid = *inbuf++;
+// Copy data payload size (size minus CID byte and checksum byte)
+size -= 2;
+*pmsg++ = size;
+// Validate data payload size: check if longer than size of testmode
+// primitive minus cid, str_len_in_bytes, and two holes FIXME: This is a
+// really bad way of doing it!
+if (size > sizeof(T_TESTMODE_PRIM) - 4)
+error = E_PACKET;
+// The CID have been received. The data that follows are part of a
+// unique struct within the union of T_TESTMODE_PRIM, so we now
+// need to align at a 32-bit word boundary.
+pmsg += 2;
+if (!error)
+{
+cksum = cid;
+while (size--)
+{
+cksum  ^= *inbuf;
+*pmsg++ = *inbuf++;
+}
+if (cksum != *inbuf)
+error = E_CHECKSUM;
+}
+// At this point, all the data have been parsed and copied into
+// the TestMode primitive.  Now we send the primitive to L1.
+if (!error)
+{
+os_send_sig(msg, L1C1_QUEUE);
+msg_used=TRUE;
+}
+else
+{
+UWORD8 mymsg[3];
+// on error, return short error message; error, cid/fid, checksum
+mymsg[0] = cid;
+mymsg[1] = error;
+mymsg[2] = cid ^ error; // checksum
+#if (TRACE_TYPE==1) || (TRACE_TYPE==4) || (TRACE_TYPE==7) || (TRACE_TYPE==0)
+rvt_send_trace_cpy((T_RVT_BUFFER) mymsg, tm_trace_user_id,3, RVT_BINARY_FORMAT);
+#endif
+}
+#endif // end of (ETM_PROTOCOL ==0)
+// if the message allocated is not sent to L1A, it has to be deallocated
+if(msg_used==FALSE)
+os_free_sig(msg);
+}
+void tm_transmit(T_TM_RETURN *tm_ret)
+{
+UWORD8 size, cksum;
+UWORD8 *pbuf, *ptmret;
+UWORD8 buf[TM_PAYLOAD_UPLINK_SIZE_MAX + TM_UPLINK_PACKET_OVERHEAD];
+pbuf = &buf[0];
+// move the header
+#if (ETM_PROTOCOL == 1)
+*pbuf++ = tm_ret->mid;
+cksum   = tm_ret->mid;
+*pbuf++ = tm_ret->status;
+cksum  ^= tm_ret->status;
+*pbuf++ = tm_ret->cid;
+cksum  ^= tm_ret->cid;
+// Include index if not equal to zero, and if not an error
+// Exception: in TX_TEMPLATE_READ we always include the index.
+if ((tm_ret->status == -ETM_OK) &&
+(tm_ret->index || tm_ret->cid == TX_TEMPLATE_READ)){
+*pbuf++ = tm_ret->index;
+cksum  ^= tm_ret->index;
+}
+#else
+*pbuf++ = tm_ret->cid;
+*pbuf++ = tm_ret->status;
+cksum = tm_ret->cid ^ tm_ret->status;
+// Include index if not equal to zero, and if not an error
+// Exception: in TX_TEMPLATE_READ we always include the index.
+if ((tm_ret->status == E_OK) &&
+(tm_ret->index || tm_ret->cid == TX_TEMPLATE_READ)){
+*pbuf++ = tm_ret->index;
+cksum  ^= tm_ret->index;
+}
+#endif
+ptmret = (UWORD8 *) &tm_ret->result[0];
+size = tm_ret->size;
+while (size--) {
+*pbuf++ = *ptmret;
+cksum ^= *ptmret++;
+}
+// move the checksum and append it to buf
+*pbuf++ = cksum;
+#if (TRACE_TYPE==1) || (TRACE_TYPE==4) || (TRACE_TYPE==7) || (TRACE_TYPE==0)
+rvt_send_trace_cpy(buf, tm_trace_user_id, pbuf - buf, RVT_BINARY_FORMAT);
+#endif
+}
+#if ((L1_STEREOPATH == 1) && (CODE_VERSION == NOT_SIMULATION) && (OP_L1_STANDALONE == 1))
+/*******************************************************************************
+*
+* UWORD16 l1tm_stereopath_get_pattern(UWORD16 sampling_freq, UWORD16 sin_freq_left,UWORD16 sin_freq_right, UWORD8 data_type)
+*
+* Purpose  : this function is use to get a complete period of a sinusoide depending on
+*            the sinusoide freq (L+R), the sampling freq and the type of samples (S8,S16,S32)
+*
+* Arguments: sampling_freq  : sampling frequency
+*            sin_freq_left  : frequency of the left channel sinusoide
+*            sin_freq_right : frequency of the right channel sinusoide
+*            data_type      : type of samples
+*
+* Returns  : number of elements in the pattern
+*
+******************************************************************************/
+UWORD16 l1tm_stereopath_get_pattern(UWORD16 sampling_freq, UWORD16 sin_freq_left,UWORD16 sin_freq_right, UWORD8 data_type)
+{
+float max_sin_period;
+float my_time;
+UWORD16 i;
+// get the lowest frequency to get the biggest period
+if (sin_freq_left > sin_freq_right)
+{
+max_sin_period =  1 / (float) sin_freq_right;
+}
+else
+{
+max_sin_period =  1 / (float) sin_freq_left;
+}
+my_time = 0;
+i = 0;
+if (data_type == AUDIO_SP_DATA_S8)
+{
+WORD8* my_ptr;
+// cast the steropath_pattern to a pointer on 8 bits samples
+my_ptr = (WORD8*) l1tm.stereopath.stereopath_pattern;
+// fill the pattern while the biggest period is not reached
+while (my_time < max_sin_period)
+{
+my_ptr[i++] = 0x7F * sin(2*3.1416*my_time*sin_freq_left);
+my_ptr[i++] = 0x7F * sin(2*3.1416*my_time*sin_freq_right);
+my_time = i/2/((float) sampling_freq);
+}
+}
+else  // S16
+{
+WORD16* my_ptr;
+// cast the steropath_pattern to a pointer on 16 bits samples
+my_ptr = (WORD16*) l1tm.stereopath.stereopath_pattern;
+// fill the pattern while the biggest period is not reached
+while (my_time < max_sin_period)
+{
+my_ptr[i++] = 0x7FFF * sin(2*3.1416*my_time*sin_freq_left);
+my_ptr[i++] = 0x7FFF * sin(2*3.1416*my_time*sin_freq_right);
+my_time = i/2/((float) sampling_freq);
+}
+}
+return (i);
+}
+/*******************************************************************************
+*
+* void l1tm_stereopath_fill_buffer(void* buffer_address)
+*
+* Purpose  : this function is use to fill a buffer with a predefined pattern
+*
+* Arguments: buffer_address  : address of the buffer to fill
+*
+* Returns  : none
+*
+******************************************************************************/
+void l1tm_stereopath_fill_buffer(void* buffer_address)
+{
+static UWORD16 my_counter = 0;
+UWORD16 copied_samples;
+UWORD16 i;
+if (l1a_l1s_com.stereopath_drv_task.parameters.data_type == AUDIO_SP_DATA_S8)
+{
+WORD8* start_address;
+WORD8* my_ptr;
+// l1tm.stereopath.stereopath_buffer_number is a variable used to know which half of the buffer we have to fill
+if (l1tm.stereopath.stereopath_buffer_number == 0)
+{
+// first half
+start_address = (WORD8*) buffer_address;
+l1tm.stereopath.stereopath_buffer_number = 1;
+}
+else
+{
+// second half, add the frame number to get the half buffer address
+start_address = ((WORD8*) buffer_address) + l1a_l1s_com.stereopath_drv_task.parameters.frame_number;
+l1tm.stereopath.stereopath_buffer_number = 0;
+}
+// copied_samples is the number of samples copied to the half buffer
+copied_samples = 0;
+// cast the steropath_pattern to a pointer on 8 bits samples
+my_ptr = (WORD8*) l1tm.stereopath.stereopath_pattern;
+if (l1a_l1s_com.stereopath_drv_task.parameters.frame_number > l1tm.stereopath.stereopath_nb_samples)
+{
+// size of the half buffer to fill is bigger than the predefined pattern
+// start to fill the buffer with the end of the not complete previous pattern (from current_sample to the last one)
+memcpy(start_address,my_ptr+l1tm.stereopath.stereopath_current_sample,l1tm.stereopath.stereopath_nb_samples-l1tm.stereopath.stereopath_current_sample);
+copied_samples = l1tm.stereopath.stereopath_nb_samples-l1tm.stereopath.stereopath_current_sample;
+// while there is still enough place in the buffer to copy a complete pattern ...
+while (copied_samples<l1a_l1s_com.stereopath_drv_task.parameters.frame_number-l1tm.stereopath.stereopath_nb_samples)
+{
+// ... copy a complete pattern
+memcpy(start_address+copied_samples,my_ptr,l1tm.stereopath.stereopath_nb_samples);
+copied_samples += l1tm.stereopath.stereopath_nb_samples;
+}
+// fill the rest of the buffer with a part of the pattern
+memcpy(start_address+copied_samples,my_ptr,l1a_l1s_com.stereopath_drv_task.parameters.frame_number-copied_samples);
+// save the last pattern sample copied in the buffer for next time (to get a continuous sound)
+l1tm.stereopath.stereopath_current_sample = l1a_l1s_com.stereopath_drv_task.parameters.frame_number-copied_samples;
+}
+else
+{
+// size of the half buffer to fill is smaller than the predefined pattern
+// fill the buffer with a part of the pattern
+memcpy(start_address,my_ptr+l1tm.stereopath.stereopath_current_sample,l1a_l1s_com.stereopath_drv_task.parameters.frame_number);
+// save the last pattern sample copied in the buffer for next time (to get a continuous sound)
+l1tm.stereopath.stereopath_current_sample += l1a_l1s_com.stereopath_drv_task.parameters.frame_number;
+if (l1tm.stereopath.stereopath_current_sample > l1tm.stereopath.stereopath_nb_samples)
+{
+l1tm.stereopath.stereopath_current_sample -= l1tm.stereopath.stereopath_nb_samples;
+}
+}
+}
+else    // S16
+{
+WORD16* start_address;
+WORD16* my_ptr;
+// l1tm.stereopath.stereopath_buffer_number is a variable used to know which half of the buffer we have to fill
+if (l1tm.stereopath.stereopath_buffer_number == 0)
+{
+// first half
+start_address = (WORD16*) buffer_address;
+l1tm.stereopath.stereopath_buffer_number = 1;
+}
+else
+{
+// second half, add the frame number to get the half buffer address
+start_address = ((WORD16*) buffer_address) + l1a_l1s_com.stereopath_drv_task.parameters.frame_number;
+l1tm.stereopath.stereopath_buffer_number = 0;
+}
+// copied_samples is the number of samples copied to the half buffer
+copied_samples = 0;
+// cast the steropath_pattern to a pointer on 16 bits samples
+my_ptr = (WORD16*) l1tm.stereopath.stereopath_pattern;
+if (l1a_l1s_com.stereopath_drv_task.parameters.frame_number > l1tm.stereopath.stereopath_nb_samples)
+{
+// size of the half buffer to fill is bigger than the predefined pattern
+// start to fill the buffer with the end of the not complete previous pattern (from current_sample to the last one)
+memcpy(start_address, my_ptr+l1tm.stereopath.stereopath_current_sample,(l1tm.stereopath.stereopath_nb_samples-l1tm.stereopath.stereopath_current_sample)*2);
+copied_samples = l1tm.stereopath.stereopath_nb_samples-l1tm.stereopath.stereopath_current_sample;
+// while there is still enough place in the buffer to copy a complete pattern ...
+while (copied_samples<l1a_l1s_com.stereopath_drv_task.parameters.frame_number-l1tm.stereopath.stereopath_nb_samples)
+{
+// ... copy a complete pattern
+memcpy(start_address+copied_samples,my_ptr,l1tm.stereopath.stereopath_nb_samples*2);
+copied_samples += l1tm.stereopath.stereopath_nb_samples;
+}
+// fill the rest of the buffer with a part of the pattern
+memcpy(start_address+copied_samples,my_ptr,(l1a_l1s_com.stereopath_drv_task.parameters.frame_number-copied_samples)*2);
+// save the last pattern sample copied in the buffer for next time (to get a continuous sound)
+l1tm.stereopath.stereopath_current_sample = l1a_l1s_com.stereopath_drv_task.parameters.frame_number-copied_samples;
+}
+else
+{
+// size of the half buffer to fill is smaller than the predefined pattern
+// fill the buffer with a part of the pattern
+memcpy(start_address,my_ptr+l1tm.stereopath.stereopath_current_sample,l1a_l1s_com.stereopath_drv_task.parameters.frame_number);
+l1tm.stereopath.stereopath_current_sample += l1a_l1s_com.stereopath_drv_task.parameters.frame_number;
+// save the last pattern sample copied in the buffer for next time (to get a continuous sound)
+if (l1tm.stereopath.stereopath_current_sample > l1tm.stereopath.stereopath_nb_samples)
+{
+l1tm.stereopath.stereopath_current_sample -= l1tm.stereopath.stereopath_nb_samples;
+}
+}
+}
+}
+/*******************************************************************************
+*
+* void l1tm_stereopath_DMA_handler(SYS_UWORD16 dma_status)
+*
+* Purpose  : this function is the stereopath DMA interrupt handler
+*
+* Arguments: dma_status  : type of interrupt
+*
+* Returns  : none
+*
+******************************************************************************/
+void l1tm_stereopath_DMA_handler(SYS_UWORD16 dma_status)
+{
+// stereopath DMA handler, check which type of interrupt it is
+if (F_DMA_COMPARE_CHANNEL_IT_STATUS_BLOCK(dma_status))
+{
+l1tm.stereopath.stereopath_block++;
+// Block --> fill a new buffer
+l1tm_stereopath_fill_buffer((void*) l1a_l1s_com.stereopath_drv_task.parameters.source_buffer_address);
+}
+if (F_DMA_COMPARE_CHANNEL_IT_STATUS_HALF_BLOCK(dma_status))
+{
+l1tm.stereopath.stereopath_half_block++;
+// Half Block --> fill a new buffer
+l1tm_stereopath_fill_buffer((void*) l1a_l1s_com.stereopath_drv_task.parameters.source_buffer_address);
+}
+if (F_DMA_COMPARE_CHANNEL_IT_STATUS_TIME_OUT_SRC(dma_status))
+l1tm.stereopath.stereopath_source_timeout++;
+if (F_DMA_COMPARE_CHANNEL_IT_STATUS_TIME_OUT_DST(dma_status))
+l1tm.stereopath.stereopath_dest_timeout++;
+if (F_DMA_COMPARE_CHANNEL_IT_STATUS_DROP(dma_status))
+l1tm.stereopath.stereopath_drop++;
+if (F_DMA_COMPARE_CHANNEL_IT_STATUS_FRAME(dma_status))
+l1tm.stereopath.stereopath_frame++;
+}
+#endif
+#if (CODE_VERSION != SIMULATION)
+void l1tm_tpu_table_write(T_TESTMODE_PRIM *prim, T_TM_RETURN *tm_return)
+{
+Cust_tm_tpu_table_write(tm_return,
+prim->u.tm_table.index,
+prim->str_len_in_bytes - 1,    // subtract 8-bit index
+prim->u.tm_table.table);
+}
+void l1tm_tpu_table_read(T_TESTMODE_PRIM *prim, T_TM_RETURN *tm_return)
+{
+Cust_tm_tpu_table_read(tm_return, prim->u.tm_table.index);
+}
+#endif // (CODE_VERSION != SIMULATION)
+/*------------------------------------------------------------------*/
+/* l1tm_PRBS1_generate()                                            */
+/*------------------------------------------------------------------*/
+/*                                                                  */
+/* Parameters  :         UWORD16 *TM_ul_data                        */
+/* -------------                                                    */
+/*                point to the uplink burts table to be filled      */
+/*                with the PRBS 1 of bits                           */
+/*                                                                  */
+/* Return      :                Void                                */
+/* -------------                                                    */
+/*                                                                  */
+/* Description :                                                    */
+/* -------------                                                    */
+/* This algorithm generates  a Pseudo Random Bit Sequence           */
+/* using a method called method  "Primitive Polynomial Modulo 2"    */
+/* For a sequence length of (2^15-1) we a polynomial of order 15    */
+/* is used, the coefficients are [ 15,  1,  0 ]                     */
+/* The basic idea is to generate the new bit by XORing  all the     */
+/* coefficients  of the polynomial except coeff 0                   */
+/* i.e newbit = ( B15 XOR B1  )                                     */
+/* The following notation must be used for the bit numbering:       */
+/* _______________________________________________________          */
+/*|B16|B15|B14|B13|B12|B11|B10|B9|B8|B7|B6|B5|B4|B3|B2|B1|          */
+/*------------------------------------------------------------------*/
+/*                                                                  */
+/* each word of the uplink buffer needs to be filled by new 10 bits */
+/*------------------------------------------------------------------*/
+void l1tm_PRBS1_generate(UWORD16 *TM_ul_data)
+{
+#define B15_MASK 	0x4000
+#define B1_MASK 	0x0001
+#define MASK_16BITS	0xFFFF
+UWORD16 newbit =0x0000;
+UWORD8 index ,word;
+//generate 16 words to fill Uplink table
+for (word=0;word<16;word++)
+{
+// generate new 10 bits from the sequence
+for (index =0; index< 10;index++)
+{
+// generate new bit , using the "Primitive Polynomial Modulo 2 " method with coeff. ( 15, 1, 0 )
+//XOR bit 15 with bit 1.
+newbit =     (((l1tm.tmode_prbs.prbs1_seed& B15_MASK)>>14)^(l1tm.tmode_prbs.prbs1_seed & B1_MASK));
+// insert new bit in the sequence.
+l1tm.tmode_prbs.prbs1_seed =	(l1tm.tmode_prbs.prbs1_seed << 1) | newbit;
+}
+TM_ul_data[word]=(UWORD16)((l1tm.tmode_prbs.prbs1_seed&MASK_16BITS)<<6);
+}
+}
+#endif // TESTMODE

FreeCalypso > hg > fc-magnetite

comparison src/cs/layer1/tm_cfile/l1tm_func.c @ 234:b870b6a44d31