changeset 579:df71726fa4e1

L1: checkpointing work in progress on tpudrv12.c
author Michael Spacefalcon <msokolov@ivan.Harhan.ORG>
date Thu, 14 Aug 2014 21:00:17 +0000
parents e9a87d682b97
children df12004ac8ee
files gsm-fw/L1/tpudrv/tpudrv12.c
diffstat 1 files changed, 1384 insertions(+), 0 deletions(-) [+]
line wrap: on
line diff
--- /dev/null	Thu Jan 01 00:00:00 1970 +0000
+++ b/gsm-fw/L1/tpudrv/tpudrv12.c	Thu Aug 14 21:00:17 2014 +0000
@@ -0,0 +1,1384 @@
+/*
+ * tpudrv12.c (TPU driver for RF type 12) is a required part of the L1
+ * code for TI GSM chipset solutions consisting of Calypso or other
+ * classic (non-LoCosto) DBB, one of the classic ABB chips such as Iota
+ * or Syren, and Rita RF transceiver; the number 12 refers to the latter.
+ *
+ * We, the FreeCalypso team, have not been able to find an original
+ * source for this C module: the LoCosto source has tpudrv61.c instead,
+ * supporting LoCosto RF instead of Rita, whereas the TSM30 source
+ * only supports non-TI RF transceivers.  Our only available reference
+ * for what this tpudrv12.c module is supposed to contain is the
+ * tpudrv12.obj COFF object from the Leonardo semi-src deliverable.
+ *
+ * The present reconstruction has been made by copying tpudrv61.c and
+ * tweaking it to match the disassembly of the reference binary object
+ * named above.
+ */
+
+#define TPUDRV12_C
+
+#include "config.h"
+#include "l1_confg.h"
+
+#include "l1_macro.h"
+#include "l1_const.h"
+#include "l1_types.h"
+#if TESTMODE
+  #include "l1tm_defty.h"
+#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
+
+#if (L1_AAC == 1)
+  #include "l1aac_defty.h"
+#endif
+
+#include "l1_defty.h"
+#include "l1_time.h"
+#include "l1_ctl.h"
+#include "tpudrv.h"
+#include "tpudrv12.h"
+#include "l1_rf12.h"
+
+#include "sys_types.h"
+
+#include "../../bsp/mem.h"
+#include "../../bsp/armio.h"
+#include "../../bsp/clkm.h"
+
+// Global variables
+extern T_L1_CONFIG l1_config;
+extern UWORD16  AGC_TABLE[];
+extern UWORD16  *TP_Ptr;
+#if (L1_FF_MULTIBAND == 1)
+extern const WORD8 rf_subband2band[RF_NB_SUBBANDS];
+#endif
+
+static WORD8   rf_index;      // index into rf_path[]
+static UWORD16 rf_chip_band;	/* from tpudrv12.obj, not in tpudrv61.c */
+static UWORD8  rfband;		/* ditto */
+
+// Internal function prototypes
+void l1dmacro_rx_down (WORD32 t);
+
+#if (L1_FF_MULTIBAND == 0)
+SYS_UWORD16 Convert_l1_radio_freq(SYS_UWORD16 radio_freq);
+WORD32 rf_init(WORD32 t);
+
+// External function prototypes
+UWORD8 Cust_is_band_high(UWORD16 radio_freq);
+#endif
+
+
+extern T_RF_BAND rf_band[];
+extern T_RF rf;
+
+/**************************************************************************/
+/**************************************************************************/
+/*         DEFINITION OF MACROS FOR CHIPS SERIAL PROGRAMMATION            */
+/**************************************************************************/
+/**************************************************************************/
+
+/*------------------------------------------*/
+/*   Is arfcn in the DCS band (512-885) ?   */
+/*------------------------------------------*/
+#define IS_HIGH_BAND(arfcn) (((arfcn >= 512) && (arfcn <= 885)) ? 1 : 0)
+
+/*------------------------------------------*/
+/*   Send a value to Rita RF                */
+/*------------------------------------------*/
+#define TSP_TO_RF(rf_data)\
+	{\
+	*TP_Ptr++ = TPU_MOVE(TSP_TX_REG_1, ((rf_data) >> 8) & 0xFF);	\
+	*TP_Ptr++ = TPU_MOVE(TSP_TX_REG_2, (rf_data) & 0xFF);		\
+	*TP_Ptr++ = TPU_MOVE(TSP_CTRL1, 0x4F);				\
+	*TP_Ptr++ = TPU_MOVE(TSP_CTRL2, 0x02);				\
+	}
+
+/*------------------------------------------*/
+/*   Send a TSP command to ABB              */
+/*------------------------------------------*/
+#define TSP_TO_ABB(data)\
+	{\
+	*TP_Ptr++ = TPU_MOVE(TSP_TX_REG_1, (data) & 0xFF);		\
+	*TP_Ptr++ = TPU_MOVE(TSP_CTRL1, 0x06);				\
+	*TP_Ptr++ = TPU_MOVE(TSP_CTRL2, 0x02);				\
+	}
+
+/*------------------------------------------*/
+/*    Trace arfcn for conversion debug      */
+/*------------------------------------------*/
+#ifdef ARFCN_DEBUG
+  // ----Debug information : record all arfcn programmed into synthesizer!
+  #define MAX_ARFCN_TRACE     4096  // enough for 5 sessions of 124+374
+  SYS_UWORD16 arfcn_trace[MAX_ARFCN_TRACE];
+  static UWORD32 arfcn_trace_index = 0;
+
+  void trace_arfcn(SYS_UWORD16 arfcn)
+  {
+    arfcn_trace[arfcn_trace_index++] = arfcn;
+
+    // Wrap to beginning
+    if (arfcn_trace_index == MAX_ARFCN_TRACE)
+      arfcn_trace_index = 0;
+  }
+#endif
+
+
+/**************************************************************************/
+/**************************************************************************/
+/*               DEFINITION OF HARWARE DEPENDANT CONSTANTS                */
+/**************************************************************************/
+/**************************************************************************/
+
+/**************************************************************************/
+/**************************************************************************/
+/*                  INTERNAL FUNCTIONS OF TPUDRV14.C                      */
+/*                 EFFECTIVE DOWNLOADING THROUGH TSP                      */
+/**************************************************************************/
+/**************************************************************************/
+// rx & tx
+typedef struct tx_rx_s
+{
+  UWORD16 farfcn0;
+  WORD8 ou;
+}
+T_TX_RX;
+
+struct synth_s {
+    // common
+    UWORD16 arfcn0;
+    UWORD16 limit;
+    UWORD16 rf_chip_band;	/* from tpudrv12.obj, not in tpudrv61.c */
+    T_TX_RX tx_rx[2];
+};
+
+struct rf_path_s {
+  UWORD8 rx_up;
+  UWORD8 rx_down;
+  UWORD8 tx_up;
+  UWORD8 tx_down;
+  struct synth_s *synth;
+};
+
+const struct synth_s synth_900[] =
+{
+  {  0,  124, BAND_SELECT_GSM, {{ 890,   1}, { 935,   2}}},// gsm    0 - 124
+  {974, 1023, BAND_SELECT_GSM, {{ 880,   1}, { 925,   2}}},// egsm 975 - 1023
+};
+
+const struct synth_s synth_1800[] =
+{
+  {511, 885, BAND_SELECT_DCS, {{1710,  1},  {1805,   1}}}, // dcs  512 - 885
+};
+
+const struct synth_s synth_1900[] =
+{
+  {511, 810, BAND_SELECT_PCS, {{1850,  1},  {1930,   1}}}, // pcs  512 - 810;
+};
+
+const struct synth_s synth_850[] =
+{
+  {127, 192, BAND_SELECT_850_LO, {{ 824,   2},  { 869,   2}}}, // gsm850 low
+  {127, 251, BAND_SELECT_850_HI, {{ 824,   1},  { 869,   2}}}, // gsm850 high
+};
+
+struct rf_path_s rf_path[] = {    //same index used as for band_config[] - 1
+  { RU_900,  RD_900,  TU_900,  TD_900,  (struct synth_s *)synth_900 }, //EGSM
+  { RU_1800, RD_1800, TU_1800, TD_1800, (struct synth_s *)synth_1800}, //DCS
+  { RU_1900, RD_1900, TU_1900, TD_1900, (struct synth_s *)synth_1900}, //PCS
+  { RU_850,  RD_850,  TU_850,  TD_850,  (struct synth_s *)synth_850 }, //GSM850
+  { RU_900,  RD_900,  TU_900,  TD_900,  (struct synth_s *)synth_900 }, //GSM
+};
+
+/*
+ * Leonardo tpudrv12.obj contains a function named calc_a_b(); there is
+ * no such function in the LoCosto version, but there is a similar-looking
+ * calc_rf_freq() function instead.  Let's try making our calc_a_b()
+ * from LoCosto's calc_rf_freq().
+ */
+
+UWORD32 calc_a_b(UWORD16 arfcn, UWORD8 downlink)
+{
+  UWORD32 farfcn;	/* in 200 kHz units */
+  UWORD32 n;		/* B * P + A */
+  struct synth_s  *s;
+
+  s = rf_path[rf_index].synth;
+  while(s->limit < arfcn)
+    s++;
+
+  rf_chip_band = s->rf_chip_band;
+
+  // Convert the ARFCN to the channel frequency (times 5 to avoid the decimal value)
+  farfcn = 5*s->tx_rx[downlink].farfcn0 + (arfcn - s->arfcn0);
+  n = farfcn * s->tx_rx[downlink].ou;
+
+  /* magic A & B encoding for Rita */
+  return((n - 4096) << 3);
+}
+
+/*------------------------------------------*/
+/*          Convert_l1_radio_freq           */
+/*------------------------------------------*/
+/*      conversion of l1 radio_freq to      */
+/*         real channel number              */
+/*------------------------------------------*/
+SYS_UWORD16 Convert_l1_radio_freq(SYS_UWORD16 radio_freq)
+{
+  switch(l1_config.std.id)
+  {
+    case GSM:
+    case DCS1800:
+    case PCS1900:
+    case GSM850:
+      return (radio_freq);
+//omaps00090550    break;
+
+    case DUAL:
+    {
+      if (radio_freq < l1_config.std.first_radio_freq_band2)
+      // GSM band...
+        return(radio_freq);
+      else
+      // DCS band...
+        return (radio_freq - l1_config.std.first_radio_freq_band2 + 512);
+    }
+//omaps00090550    break;
+
+    case DUALEXT:
+    {
+      if (radio_freq < l1_config.std.first_radio_freq_band2)
+      // E-GSM band...
+      {
+        if(radio_freq <= 124)
+        // GSM part...
+          return(radio_freq);
+        if(radio_freq < 174)
+        // Extended part...
+          return (radio_freq - 125 + 975);
+        else
+        // Extended part, special case of ARFCN=0
+          return(0);
+      }
+      else
+      {
+      // DCS band...
+        return (radio_freq - l1_config.std.first_radio_freq_band2 + 512);
+      }
+    }
+//    break;
+
+   case GSM_E:
+    {
+      if(radio_freq <= 124)
+      // GSM part...
+        return(radio_freq);
+      else
+      if(radio_freq < 174)
+      // Extended part...
+        return (radio_freq - 125 + 975);
+      else
+      // Extended part, special case of ARFCN=0
+        return(0);
+    }
+//omaps00090550    break;
+
+    case DUAL_US:
+    {
+      if (radio_freq < l1_config.std.first_radio_freq_band2)
+      {
+        return(radio_freq - l1_config.std.first_radio_freq + 128);
+      }
+      else
+      {
+      // PCS band...
+        return (radio_freq - l1_config.std.first_radio_freq_band2 + 512);
+      }
+    }
+//    break;
+
+    default: // should never occur.
+      return(radio_freq);
+  }  // end of switch
+}
+
+/*------------------------------------------*/
+/*              rf_init                     */
+/*------------------------------------------*/
+/*    Initialization routine for PLL        */
+/*   Effective downloading through TSP      */
+/*------------------------------------------*/
+/* Rita and LoCosto versions look totally   */
+/* different, reconstructing from disasm.   */
+/*------------------------------------------*/
+WORD32 rf_init(WORD32 t)
+{
+	*TP_Ptr++ = TPU_AT(t);
+	*TP_Ptr++ = TPU_MOVE(TSP_CTRL1, 0x47);
+	t += 5;
+	*TP_Ptr++ = TPU_AT(t);
+	*TP_Ptr++ = TPU_MOVE(TSP_ACT, 0x00);
+	t += 8;
+	*TP_Ptr++ = TPU_AT(t);
+	*TP_Ptr++ = TPU_MOVE(TSP_ACT, 0x01);
+	t += 5;
+	*TP_Ptr++ = TPU_AT(t);
+	TSP_TO_RF(0x0012);
+	t += 7;
+	*TP_Ptr++ = TPU_AT(t);
+	*TP_Ptr++ = TPU_AT(t);
+	*TP_Ptr++ = TPU_AT(t);
+	*TP_Ptr++ = TPU_AT(t);
+	*TP_Ptr++ = TPU_AT(t);
+	*TP_Ptr++ = TPU_AT(t);
+	TSP_TO_RF(0x003A);
+	t += 117;
+	*TP_Ptr++ = TPU_AT(t);
+	TSP_TO_RF(0xC003);
+	t += 7;
+	*TP_Ptr++ = TPU_AT(t);
+	TSP_TO_RF(0x02FE);
+	t += 7;
+	*TP_Ptr++ = TPU_AT(t);
+	TSP_TO_RF(0x401F);
+	t += 7;
+	*TP_Ptr++ = TPU_AT(t);
+	TSP_TO_RF(0x043D);
+	t += 7;
+	return(t);
+}
+
+/*------------------------------------------*/
+/*              rf_init_light               */
+/*------------------------------------------*/
+/*    Initialization routine for PLL        */
+/*   Effective downloading through TSP      */
+/*------------------------------------------*/
+WORD32 rf_init_light(WORD32 t)
+{
+  // initialization for change of multi-band configuration dependent on STD
+  return(t);
+}
+
+UWORD8 arfcn_to_rf_index(SYS_UWORD16 arfcn)
+{
+  UWORD8 index;
+  extern const T_STD_CONFIG std_config[];
+  index = std_config[l1_config.std.id].band[0];
+
+  if ((std_config[l1_config.std.id].band[1] != BAND_NONE) && IS_HIGH_BAND(arfcn))
+    index = std_config[l1_config.std.id].band[1];
+
+  return (index - 1);
+}
+
+/*------------------------------------------*/
+/*              rf_program                  */
+/*------------------------------------------*/
+/*      Programs the RF synthesizer         */
+/*           called each frame              */
+/*      downloads NA counter value          */
+/*    t = start time in the current frame   */
+/*------------------------------------------*/        //change 2 UWORD8
+UWORD32 rf_program(UWORD32 t, SYS_UWORD16 radio_freq, UWORD32 rx)
+{
+  UWORD32 rfdiv;
+  SYS_UWORD16 arfcn;
+
+  rfband = Cust_is_band_high(radio_freq);
+
+  arfcn = Convert_l1_radio_freq(radio_freq);
+  #ifdef ARFCN_DEBUG
+    trace_arfcn(arfcn);
+  #endif
+  rf_index = arfcn_to_rf_index(arfcn);
+
+  rfdiv = calc_a_b(arfcn, rx);
+
+  if (rx != 1) {
+    TSP_TO_RF(rfdiv | REG_PLL);
+    *TP_Ptr++ = TPU_FAT(0x1274);
+    TSP_TO_RF(0x043A | rf_chip_band);
+  } else {
+    TSP_TO_RF(rfdiv | REG_PLL);
+    *TP_Ptr++ = TPU_FAT(0x12FD);
+    TSP_TO_RF(0x023A | rf_chip_band);
+  }
+
+  return(t);
+}
+
+/**************************************************************************/
+/**************************************************************************/
+/*                    EXTERNAL FUNCTIONS CALLED BY LAYER1                 */
+/*                          COMMON TO L1 and TOOLKIT                      */
+/**************************************************************************/
+/**************************************************************************/
+
+/*------------------------------------------*/
+/*                agc                       */
+/*------------------------------------------*/
+/*      Program a gain into IF amp          */
+/*      agc_value : gain in dB              */
+/*                                          */
+/*   additional parameter for LNA setting   */
+/*------------------------------------------*/
+/* Rita and LoCosto versions look totally   */
+/* different, reconstructing from disasm.   */
+/*------------------------------------------*/
+
+void l1dmacro_agc(SYS_UWORD16 radio_freq, WORD8 gain, UWORD8 lna_off)
+{
+	int agc_table_index;
+	UWORD16 rf_data;
+
+	agc_table_index = gain - 2;
+	if (agc_table_index < 0)
+		agc_table_index++;
+	agc_table_index >>= 1;
+	if (gain >= 42)
+		agc_table_index = 19;
+	if (gain < 16)
+		agc_table_index = 6;
+	*TP_Ptr++ = TPU_FAT(0x1334);
+	rf_data = REG_RX;
+	if (!lna_off)
+		rf_data |= RF_GAIN;
+	rf_data |= AGC_TABLE[agc_table_index] << 11;
+	rf_data |= RX_CAL_MODE;
+	TSP_TO_RF(rf_data);
+}
+
+/*------------------------------------------*/
+/*             l1dmacro_rx_synth            */
+/*------------------------------------------*/
+/*       programs RF synth for recceive     */
+/*------------------------------------------*/
+void l1dmacro_rx_synth(SYS_UWORD16 radio_freq)
+{
+   UWORD32 t;
+
+   // Important: always use rx_synth_start_time for first TPU_AT
+   // Never remove below 2 lines!!!
+   t = l1_config.params.rx_synth_start_time;
+   *TP_Ptr++ = TPU_FAT (t);
+
+   t = rf_program(t, radio_freq, 1);   // direction is set to 1 for Rx
+}
+
+/*------------------------------------------*/
+/*            l1dmacro_tx_synth             */
+/*------------------------------------------*/
+/*      programs RF synth for transmit      */
+/*      programs OPLL for transmit          */
+/*------------------------------------------*/
+void l1dmacro_tx_synth(SYS_UWORD16 radio_freq)
+{
+   UWORD32 t;
+
+   // Important: always use tx_synth_start_time for first TPU_AT
+   // Never remove below 2 lines!!!
+   t =   l1_config.params.tx_synth_start_time;
+   *TP_Ptr++ = TPU_FAT (t);
+
+   t = rf_program(t, radio_freq, 0); // direction set to 0 for Tx
+}
+
+/*------------------------------------------*/
+/*            l1dmacro_rx_up                */
+/*------------------------------------------*/
+/* Open window for normal burst reception   */
+/*------------------------------------------*/
+/* Rita version differs from LoCosto,       */
+/* reconstructing from disassembly.         */
+/*------------------------------------------*/
+void l1dmacro_rx_up (void)
+{
+	*TP_Ptr++ = TPU_FAT(0x1377);
+	TSP_TO_RF(0x0A3A | rf_chip_band);
+	*TP_Ptr++ = TPU_FAT(0x137E);
+	TSP_TO_ABB(0x10);
+	*TP_Ptr++ = TPU_FAT(0x1383);
+	TSP_TO_ABB(0x18);
+	*TP_Ptr++ = TPU_FAT(58);
+	*TP_Ptr++ = TPU_MOVE(TSP_ACT, rf_path[rf_index].rx_up | 0x01);
+	*TP_Ptr++ = TPU_FAT(62);
+	TSP_TO_ABB(0x14);
+}
+
+/*------------------------------------------*/
+/*            l1pdmacro_rx_down             */
+/*------------------------------------------*/
+/* Close window for normal burst reception  */
+/*------------------------------------------*/
+/* Rita version differs from LoCosto,       */
+/* reconstructing from disassembly.         */
+/*------------------------------------------*/
+void l1dmacro_rx_down (WORD32 t)
+{
+	*TP_Ptr++ = TPU_FAT(t - 37);
+	TSP_TO_RF(0x003A);
+	*TP_Ptr++ = TPU_MOVE(TSP_ACT, rf_path[rf_index].rx_down | 0x01);
+	*TP_Ptr++ = TPU_FAT(t - 4);
+	TSP_TO_ABB(0x00);
+}
+
+/*------------------------------------------*/
+/*            l1dmacro_tx_up                */
+/*------------------------------------------*/
+/* Open transmission window for normal burst*/
+/*------------------------------------------*/
+/* Rita version differs from LoCosto,       */
+/* reconstructing from disassembly.         */
+/*------------------------------------------*/
+void l1dmacro_tx_up (void)
+{
+	if (l1_config.std.id == DCS1800 ||
+	    rfband == MULTI_BAND2 &&
+	    (l1_config.std.id == DUAL || l1_config.std.id == DUALEXT)) {
+		*TP_Ptr++ = TPU_FAT(0x127E);
+		TSP_TO_RF(0x0007);
+		*TP_Ptr++ = TPU_FAT(0x1288);
+		TSP_TO_RF(0xC00B);
+		*TP_Ptr++ = TPU_FAT(0x1292);
+		TSP_TO_RF(0x3077);
+	} else {
+		*TP_Ptr++ = TPU_FAT(0x127E);
+		TSP_TO_RF(0xC003);
+	}
+	*TP_Ptr++ = TPU_FAT(0x12C6);
+	TSP_TO_ABB(0x80);
+	*TP_Ptr++ = TPU_FAT(0x12E3);
+	TSP_TO_RF(0x243A | rf_chip_band);
+	*TP_Ptr++ = TPU_FAT(0x1302);
+	TSP_TO_ABB(0xC0);
+	*TP_Ptr++ = TPU_FAT(0x1352);
+	TSP_TO_ABB(0x80);
+	*TP_Ptr++ = TPU_FAT(0x1384);
+	TSP_TO_ABB(0xA0);
+	*TP_Ptr++ = TPU_FAT(16);
+	*TP_Ptr++ = TPU_MOVE(TSP_ACT, rf_path[rf_index].tx_up | 0x01);
+
+
+}
+
+/*-------------------------------------------*/
+/*            l1dmacro_tx_down               */
+/*-------------------------------------------*/
+/* Close transmission window for normal burst*/
+/*-------------------------------------------*/
+#if (L1_RF_KBD_FIX == 1)
+void l1dmacro_tx_down (WORD32 t, BOOL tx_flag, UWORD8 adc_active, UWORD8 kbd_config)
+{
+  UWORD8 kbd_tspact_config =0;
+
+  if (kbd_config == KBD_DISABLED)
+		kbd_tspact_config =  KBD_DIS_TSPACT;
+
+
+  if (adc_active == ACTIVE) {
+    // 36qbits = (10qbits for  TPU programming) + (26qbits duration to convert the first ADC channel (= Battery))
+    	if ((t)<(TRF_T8+2-TRF_T9))		//Done to enable RACH Burst Support
+    		{
+    		l1dmacro_adc_read_tx (TRF_T8+10, rf_path[rf_index].tx_up);
+    		}
+	else
+		{
+    l1dmacro_adc_read_tx (t + TRF_T9, rf_path[rf_index].tx_up);
+  }
+  }
+
+
+
+  // t10: disable APC
+  *TP_Ptr++ = TPU_FAT (t + TRF_T10);
+  *TP_Ptr++ = TPU_MOVE(REG_SPI_ACT_L, kbd_tspact_config | LDO_EN | APC_EN | TX_START );
+
+  // t11: disable PA
+  *TP_Ptr++ = TPU_FAT (t + TRF_T11);
+  *TP_Ptr++ = TPU_MOVE(REG_SPI_ACT_U, rf_path[rf_index].tx_down);
+	// disable Tx_Start
+  *TP_Ptr++ = TPU_MOVE(REG_SPI_ACT_L, kbd_tspact_config | LDO_EN | APC_EN );
+
+  // t12: power off Locosto: IDLE SCRIPT
+  *TP_Ptr++ = TPU_FAT (t + TRF_T12);
+  MOVE_REG_TSP_TO_RF(START_SCRIPT(DRP_IDLE), ((UWORD16)( ((UWORD32)(&drp_regs->SCRIPT_STARTL))&0xFFFF)));
+
+  // t13: Switch off APC
+  *TP_Ptr++ = TPU_FAT (t + TRF_T13);
+  *TP_Ptr++ = TPU_MOVE(REG_SPI_ACT_L, 0);
+
+  }
+#endif /*(L1_RF_KBD_FIX == 1)*/
+
+
+
+#if (L1_RF_KBD_FIX == 0)
+void l1dmacro_tx_down (WORD32 t, BOOL tx_flag, UWORD8 adc_active)
+{
+
+  if (adc_active == ACTIVE) {
+    // 36qbits = (10qbits for  TPU programming) + (26qbits duration to convert the first ADC channel (= Battery))
+    l1dmacro_adc_read_tx (t + TRF_T9, rf_path[rf_index].tx_up);
+  }
+
+   // t10: disable APC
+  *TP_Ptr++ = TPU_FAT (t + TRF_T10);
+  *TP_Ptr++ = TPU_MOVE(REG_SPI_ACT_L, kbd_tspact_config | LDO_EN | APC_EN | TX_START );
+
+  // t11: disable PA
+  *TP_Ptr++ = TPU_FAT (t + TRF_T11);
+  *TP_Ptr++ = TPU_MOVE(REG_SPI_ACT_U, rf_path[rf_index].tx_down);
+	// disable Tx_Start
+  *TP_Ptr++ = TPU_MOVE(REG_SPI_ACT_L, kbd_tspact_config | LDO_EN | APC_EN );
+
+  // t12: power off Locosto: IDLE SCRIPT
+  *TP_Ptr++ = TPU_FAT (t + TRF_T12);
+  MOVE_REG_TSP_TO_RF(START_SCRIPT(DRP_IDLE), (UWORD16)(&drp_regs->SCRIPT_STARTL));
+
+  // t13: Switch off APC
+  *TP_Ptr++ = TPU_FAT (t + TRF_T13);
+  *TP_Ptr++ = TPU_MOVE(REG_SPI_ACT_L, 0);
+
+}
+
+
+#endif/*(L1_RF_KBD_FIX == 0)*/
+
+/*
+ * l1dmacro_rx_nb
+ *
+ * Receive Normal burst
+ */
+#if (L1_RF_KBD_FIX == 1)
+ #if (L1_MADC_ON == 1)
+void l1dmacro_rx_nb (SYS_UWORD16 radio_freq, UWORD8 adc_active, UWORD8 csf_filter_choice
+										#if(NEW_SNR_THRESHOLD==1)
+											, UWORD8 saic_flag_rx_up
+										#endif
+										)
+{
+	l1dmacro_rx_up(adc_active, csf_filter_choice, L1_KBD_DIS_RX_NB
+										#if(NEW_SNR_THRESHOLD==1)
+											, saic_flag_rx_up
+										#endif
+										);
+    l1dmacro_rx_down (STOP_RX_SNB);
+	l1s.total_kbd_on_time = l1s.total_kbd_on_time - L1_KBD_DIS_RX_NB * (-TRF_R3_1 + STOP_RX_SNB - TRF_R7);
+}
+#else
+void l1dmacro_rx_nb (SYS_UWORD16 radio_freq,UWORD8 csf_filter_choice
+										#if(NEW_SNR_THRESHOLD==1)
+											, UWORD8 saic_flag_rx_up
+										#endif
+										)
+{
+  l1dmacro_rx_up(csf_filter_choice, L1_KBD_DIS_RX_NB
+										#if(NEW_SNR_THRESHOLD==1)
+											, saic_flag_rx_up
+										#endif
+										);
+  l1dmacro_rx_down (STOP_RX_SNB);
+  l1s.total_kbd_on_time = l1s.total_kbd_on_time - L1_KBD_DIS_RX_NB * (-TRF_R3_1 + STOP_RX_SNB - TRF_R7);
+}
+#endif
+#endif /*(L1_RF_KBD_FIX == 1)*/
+
+#if (L1_RF_KBD_FIX == 0)
+ #if (L1_MADC_ON == 1)
+void l1dmacro_rx_nb (SYS_UWORD16 radio_freq, UWORD8 adc_active, UWORD8 csf_filter_choice
+										#if(NEW_SNR_THRESHOLD==1)
+											, UWORD8 saic_flag_rx_up
+										#endif
+										)
+{
+    l1dmacro_rx_up(adc_active, csf_filter_choice
+										#if(NEW_SNR_THRESHOLD==1)
+											, saic_flag_rx_up
+										#endif
+										);
+    l1dmacro_rx_down (STOP_RX_SNB);
+
+}
+#else
+void l1dmacro_rx_nb (SYS_UWORD16 radio_freq,UWORD8 csf_filter_choice
+										#if(NEW_SNR_THRESHOLD==1)
+											, UWORD8 saic_flag_rx_up
+										#endif
+										)
+{
+  l1dmacro_rx_up(csf_filter_choice
+							#if(NEW_SNR_THRESHOLD==1)
+								, saic_flag_rx_up
+							#endif
+										);
+  l1dmacro_rx_down (STOP_RX_SNB);
+
+}
+#endif
+
+#endif/*(L1_RF_KBD_FIX == 0)*/
+
+
+
+/*
+ * l1dmacro_rx_sb
+ * Receive Synchro burst
+*/
+#if (L1_RF_KBD_FIX == 1)
+#if (L1_MADC_ON == 1)
+void l1dmacro_rx_sb (SYS_UWORD16 radio_freq,UWORD8 adc_active)
+{
+  l1dmacro_rx_up(adc_active, L1_SAIC_HARDWARE_FILTER, L1_KBD_DIS_RX_SB
+  	#if(NEW_SNR_THRESHOLD==1)
+	, SAIC_OFF
+	#endif
+	);
+
+  l1dmacro_rx_down (STOP_RX_SB);
+  l1s.total_kbd_on_time = l1s.total_kbd_on_time - L1_KBD_DIS_RX_SB * (-TRF_R3_1 + STOP_RX_SB - TRF_R7);
+}
+
+#else
+void l1dmacro_rx_sb (SYS_UWORD16 radio_freq)
+{
+  l1dmacro_rx_up(L1_SAIC_HARDWARE_FILTER, L1_KBD_DIS_RX_SB
+  	#if(NEW_SNR_THRESHOLD==1)
+	, SAIC_OFF
+	#endif
+	);
+  l1dmacro_rx_down (STOP_RX_SB);
+  l1s.total_kbd_on_time = l1s.total_kbd_on_time - L1_KBD_DIS_RX_SB * (-TRF_R3_1 + STOP_RX_SB - TRF_R7);
+}
+#endif
+
+#endif/*(L1_RF_KBD_FIX == 1)*/
+
+#if(L1_RF_KBD_FIX == 0)
+#if (L1_MADC_ON == 1)
+void l1dmacro_rx_sb (SYS_UWORD16 radio_freq,UWORD8 adc_active)
+{
+  l1dmacro_rx_up(adc_active, L1_SAIC_HARDWARE_FILTER
+  	#if(NEW_SNR_THRESHOLD==1)
+	, SAIC_OFF
+	#endif
+	);
+  l1dmacro_rx_down (STOP_RX_SB);
+
+}
+
+#else
+void l1dmacro_rx_sb (SYS_UWORD16 radio_freq)
+{
+  l1dmacro_rx_up(L1_SAIC_HARDWARE_FILTER
+  	#if(NEW_SNR_THRESHOLD==1)
+	, SAIC_OFF
+	#endif
+	);
+  l1dmacro_rx_down (STOP_RX_SB);
+
+}
+#endif
+
+#endif/*(L1_RF_KBD_FIX == 0)*/
+
+/*
+ * l1dmacro_rx_ms
+ *
+ * Receive Power Measurement window
+ */
+ #if(L1_RF_KBD_FIX == 1)
+ #if (L1_MADC_ON == 1)
+ void l1dmacro_rx_ms (SYS_UWORD16 radio_freq,UWORD8 adc_active)
+{
+  l1dmacro_rx_up(adc_active, L1_SAIC_HARDWARE_FILTER, L1_KBD_DIS_RX_MS
+  	#if(NEW_SNR_THRESHOLD==1)
+	, SAIC_OFF
+	#endif
+	);
+  l1dmacro_rx_down (STOP_RX_PW_1);
+  l1s.total_kbd_on_time = l1s.total_kbd_on_time - L1_KBD_DIS_RX_MS * (-TRF_R3_1 + STOP_RX_PW_1 - TRF_R7);
+}
+
+ #else
+void l1dmacro_rx_ms (SYS_UWORD16 radio_freq)
+{
+  l1dmacro_rx_up(L1_SAIC_HARDWARE_FILTER, L1_KBD_DIS_RX_MS
+  	#if(NEW_SNR_THRESHOLD==1)
+	, SAIC_OFF
+	#endif
+	);
+  l1dmacro_rx_down (STOP_RX_PW_1);
+  l1s.total_kbd_on_time = l1s.total_kbd_on_time - L1_KBD_DIS_RX_MS * (-TRF_R3_1 + STOP_RX_PW_1 - TRF_R7);
+}
+#endif
+#endif/*(L1_RF_KBD_FIX == 1)*/
+
+#if(L1_RF_KBD_FIX == 0)
+#if (L1_MADC_ON == 1)
+ void l1dmacro_rx_ms (SYS_UWORD16 radio_freq,UWORD8 adc_active)
+{
+  l1dmacro_rx_up(adc_active, L1_SAIC_HARDWARE_FILTER
+  	#if(NEW_SNR_THRESHOLD==1)
+	, SAIC_OFF
+	#endif
+	);
+  l1dmacro_rx_down (STOP_RX_PW_1);
+
+}
+
+ #else
+void l1dmacro_rx_ms (SYS_UWORD16 radio_freq)
+{
+  l1dmacro_rx_up(L1_SAIC_HARDWARE_FILTER
+  	#if(NEW_SNR_THRESHOLD==1)
+	, SAIC_OFF
+	#endif
+	);
+  l1dmacro_rx_down (STOP_RX_PW_1);
+
+}
+#endif
+
+#endif/*(L1_RF_KBD_FIX == 0)*/
+
+/*
+ * l1dmacro_rx_fb
+ *
+ * Receive Frequency burst
+ */
+#if(L1_RF_KBD_FIX == 1)
+#if (L1_MADC_ON == 1)
+void l1dmacro_rx_fb (SYS_UWORD16 radio_freq,UWORD8 adc_active)
+#else
+void l1dmacro_rx_fb (SYS_UWORD16 radio_freq)
+#endif
+{
+#if (L1_MADC_ON == 1)
+  l1dmacro_rx_up(adc_active, L1_SAIC_HARDWARE_FILTER, L1_KBD_DIS_RX_FB
+  	#if(NEW_SNR_THRESHOLD==1)
+	, SAIC_OFF
+	#endif
+	);
+#else
+  l1dmacro_rx_up(L1_SAIC_HARDWARE_FILTER, L1_KBD_DIS_RX_FB
+  	#if(NEW_SNR_THRESHOLD==1)
+	, SAIC_OFF
+	#endif
+	);
+#endif
+  l1s.total_kbd_on_time = 5000;
+  *TP_Ptr++ = TPU_AT(0);
+  *TP_Ptr++ = TPU_AT(0);
+  *TP_Ptr++ = TPU_AT(0);
+  *TP_Ptr++ = TPU_AT(0);
+  *TP_Ptr++ = TPU_AT(0);
+  *TP_Ptr++ = TPU_AT(0);
+  *TP_Ptr++ = TPU_AT(0);
+  *TP_Ptr++ = TPU_AT(0);
+  *TP_Ptr++ = TPU_AT(0);
+  *TP_Ptr++ = TPU_AT(0);
+  *TP_Ptr++ = TPU_AT(0);
+
+  l1dmacro_rx_down (STOP_RX_FB);
+  l1s.total_kbd_on_time = l1s.total_kbd_on_time - L1_KBD_DIS_RX_FB * (STOP_RX_FB - TRF_R7);
+}
+#endif/*(L1_RF_KBD_FIX == 1)*/
+
+#if(L1_RF_KBD_FIX == 0)
+#if (L1_MADC_ON == 1)
+void l1dmacro_rx_fb (SYS_UWORD16 radio_freq,UWORD8 adc_active)
+#else
+void l1dmacro_rx_fb (SYS_UWORD16 radio_freq)
+#endif
+{
+#if (L1_MADC_ON == 1)
+  l1dmacro_rx_up(adc_active, L1_SAIC_HARDWARE_FILTER
+  	#if(NEW_SNR_THRESHOLD==1)
+	, SAIC_OFF
+	#endif
+	);
+#else
+  l1dmacro_rx_up(L1_SAIC_HARDWARE_FILTER
+  	#if(NEW_SNR_THRESHOLD==1)
+	, SAIC_OFF
+	#endif
+	);
+#endif
+
+  *TP_Ptr++ = TPU_AT(0);
+  *TP_Ptr++ = TPU_AT(0);
+  *TP_Ptr++ = TPU_AT(0);
+  *TP_Ptr++ = TPU_AT(0);
+  *TP_Ptr++ = TPU_AT(0);
+  *TP_Ptr++ = TPU_AT(0);
+  *TP_Ptr++ = TPU_AT(0);
+  *TP_Ptr++ = TPU_AT(0);
+  *TP_Ptr++ = TPU_AT(0);
+  *TP_Ptr++ = TPU_AT(0);
+  *TP_Ptr++ = TPU_AT(0);
+
+  l1dmacro_rx_down (STOP_RX_FB);
+
+}
+
+#endif/*(L1_RF_KBD_FIX == 0)*/
+
+/*
+ * l1dmacro_rx_fb26
+ *
+ * Receive Frequency burst for TCH.
+ */
+ #if(L1_RF_KBD_FIX == 1)
+ #if (L1_MADC_ON == 1)
+ void l1dmacro_rx_fb26 (SYS_UWORD16 radio_freq,UWORD8 adc_active)
+{
+  l1dmacro_rx_up(adc_active, L1_SAIC_HARDWARE_FILTER, L1_KBD_DIS_RX_FB26
+  	#if(NEW_SNR_THRESHOLD==1)
+	, SAIC_OFF
+	#endif
+	);
+  l1s.total_kbd_on_time = 5000;
+  *TP_Ptr++ = TPU_AT(0);
+
+  l1dmacro_rx_down (STOP_RX_FB26);
+  l1s.total_kbd_on_time = l1s.total_kbd_on_time - L1_KBD_DIS_RX_FB26 * (STOP_RX_FB26 - TRF_R7);
+}
+
+ #else
+void l1dmacro_rx_fb26 (SYS_UWORD16 radio_freq)
+{
+  l1dmacro_rx_up(L1_SAIC_HARDWARE_FILTER, L1_KBD_DIS_RX_FB26
+  	#if(NEW_SNR_THRESHOLD==1)
+	, SAIC_OFF
+	#endif
+	);
+  l1s.total_kbd_on_time = 5000;
+  *TP_Ptr++ = TPU_AT(0);
+
+  l1dmacro_rx_down (STOP_RX_FB26);
+  l1s.total_kbd_on_time = l1s.total_kbd_on_time - L1_KBD_DIS_RX_FB26 * (STOP_RX_FB26 - TRF_R7);
+}
+#endif
+#endif/*(L1_RF_KBD_FIX == 1)*/
+
+#if(L1_RF_KBD_FIX == 0)
+#if (L1_MADC_ON == 1)
+ void l1dmacro_rx_fb26 (SYS_UWORD16 radio_freq,UWORD8 adc_active)
+{
+  l1dmacro_rx_up(adc_active, L1_SAIC_HARDWARE_FILTER
+  	#if(NEW_SNR_THRESHOLD==1)
+	, SAIC_OFF
+	#endif
+	);
+
+  *TP_Ptr++ = TPU_AT(0);
+
+  l1dmacro_rx_down (STOP_RX_FB26);
+
+}
+
+ #else
+void l1dmacro_rx_fb26 (SYS_UWORD16 radio_freq)
+{
+  l1dmacro_rx_up(L1_SAIC_HARDWARE_FILTER
+  	#if(NEW_SNR_THRESHOLD==1)
+	, SAIC_OFF
+	#endif
+	);
+
+  *TP_Ptr++ = TPU_AT(0);
+
+  l1dmacro_rx_down (STOP_RX_FB26);
+
+}
+#endif
+#endif/*(L1_RF_KBD_FIX == 0)*/
+
+/*
+ * l1dmacro_tx_nb
+ *
+ * Transmit Normal burst
+ */
+#if(L1_RF_KBD_FIX == 1)
+
+ void l1dmacro_tx_nb (SYS_UWORD16 radio_freq, UWORD8 txpwr, UWORD8 adc_active)
+{
+  l1dmacro_tx_up (L1_KBD_DIS_TX_NB);
+  l1dmacro_tx_down (l1_config.params.tx_nb_duration, FALSE, adc_active, L1_KBD_DIS_TX_NB);
+  l1s.total_kbd_on_time = l1s.total_kbd_on_time - L1_KBD_DIS_TX_NB * (-TRF_T3_1 + l1_config.params.tx_nb_duration + TRF_T12);
+}
+
+#endif/*#if(L1_RF_KBD_FIX == 1)*/
+
+#if(L1_RF_KBD_FIX == 0)
+ void l1dmacro_tx_nb (SYS_UWORD16 radio_freq, UWORD8 txpwr, UWORD8 adc_active)
+{
+  l1dmacro_tx_up ();
+  l1dmacro_tx_down (l1_config.params.tx_nb_duration, FALSE, adc_active);
+
+}
+
+#endif/*#if(L1_RF_KBD_FIX == 0)*/
+
+/*
+ * l1dmacro_tx_ra
+ *
+ * Transmit Random Access burst
+ */
+#if(L1_RF_KBD_FIX == 1)
+
+void l1dmacro_tx_ra (SYS_UWORD16 radio_freq, UWORD8 txpwr, UWORD8 adc_active)
+{
+  l1dmacro_tx_up (L1_KBD_DIS_TX_RA);
+  l1dmacro_tx_down (l1_config.params.tx_ra_duration, FALSE, adc_active, L1_KBD_DIS_TX_RA);
+  l1s.total_kbd_on_time = l1s.total_kbd_on_time - L1_KBD_DIS_TX_RA * (-TRF_T3_1 + l1_config.params.tx_ra_duration + TRF_T12);
+}
+#endif /*#if(L1_RF_KBD_FIX == 1)*/
+
+#if(L1_RF_KBD_FIX == 0)
+void l1dmacro_tx_ra (SYS_UWORD16 radio_freq, UWORD8 txpwr, UWORD8 adc_active)
+{
+  l1dmacro_tx_up ();
+  l1dmacro_tx_down (l1_config.params.tx_ra_duration, FALSE, adc_active);
+
+}
+#endif/*#if(L1_RF_KBD_FIX == 0)*/
+
+  /*
+   * l1dmacro_rx_cont
+   *
+   * Receive continuously
+   */
+#if(L1_RF_KBD_FIX == 1)
+ #if (L1_MADC_ON == 1)
+ void l1dmacro_rx_cont (SYS_UWORD16 radio_freq, UWORD8 txpwr,
+                        UWORD8 adc_active, UWORD8 csf_filter_choice
+										#if(NEW_SNR_THRESHOLD==1)
+											, UWORD8 saic_flag_rx_up
+										#endif
+										)
+{
+  l1dmacro_rx_up (adc_active, csf_filter_choice, KBD_DISABLED
+										#if(NEW_SNR_THRESHOLD==1)
+											, saic_flag_rx_up
+										#endif
+										);
+}
+ #else
+void l1dmacro_rx_cont (SYS_UWORD16 radio_freq, UWORD8 txpwr,
+                       UWORD8 csf_filter_choice
+								#if(NEW_SNR_THRESHOLD==1)
+									, UWORD8 saic_flag_rx_up
+								#endif
+								)
+{
+  l1dmacro_rx_up (csf_filter_choice,KBD_DISABLED
+								#if(NEW_SNR_THRESHOLD==1)
+									, saic_flag_rx_up
+								#endif
+								);
+}
+#endif
+#endif/*#if(L1_RF_KBD_FIX == 1)*/
+
+#if(L1_RF_KBD_FIX == 0)
+ #if (L1_MADC_ON == 1)
+ void l1dmacro_rx_cont (SYS_UWORD16 radio_freq, UWORD8 txpwr,
+                        UWORD8 adc_active, UWORD8 csf_filter_choice
+								#if(NEW_SNR_THRESHOLD==1)
+									, UWORD8 saic_flag_rx_up
+								#endif
+								)
+{
+  l1dmacro_rx_up (adc_active, csf_filter_choice
+								#if(NEW_SNR_THRESHOLD==1)
+									, saic_flag_rx_up
+								#endif
+								);
+}
+ #else
+void l1dmacro_rx_cont (SYS_UWORD16 radio_freq, UWORD8 txpwr,
+                       UWORD8 csf_filter_choice
+							#if(NEW_SNR_THRESHOLD==1)
+								, UWORD8 saic_flag_rx_up
+							#endif
+							)
+{
+  l1dmacro_rx_up (csf_filter_choice
+						#if(NEW_SNR_THRESHOLD==1)
+							, saic_flag_rx_up
+						#endif
+						);
+}
+#endif
+
+#endif/*#if(L1_RF_KBD_FIX == 0)*/
+
+
+  /*
+   * l1dmacro_tx_cont
+   *
+   * Transmit continuously
+   */
+#if(L1_RF_KBD_FIX == 1)
+void l1dmacro_tx_cont (SYS_UWORD16 radio_freq, UWORD8 txpwr)
+{
+  l1dmacro_tx_up (KBD_DISABLED);
+}
+#endif/*#if(L1_RF_KBD_FIX == 1)*/
+
+#if(L1_RF_KBD_FIX == 0)
+void l1dmacro_tx_cont (SYS_UWORD16 radio_freq, UWORD8 txpwr)
+{
+  l1dmacro_tx_up ();
+}
+#endif/*#if(L1_RF_KBD_FIX == 0)*/
+
+  /*
+   * l1d_macro_stop_cont
+   *
+   * Stop continuous Tx or Rx
+   */
+#if(L1_RF_KBD_FIX == 1)
+void l1dmacro_stop_cont (void)
+{
+  if (l1_config.tmode.rf_params.down_up == TMODE_DOWNLINK)
+    l1dmacro_rx_down(STOP_RX_SNB);
+  else
+    l1dmacro_tx_down(l1_config.params.tx_nb_duration, FALSE, 0, KBD_DISABLED);
+}
+#endif/*#if(L1_RF_KBD_FIX == 1)*/
+
+#if(L1_RF_KBD_FIX == 0)
+void l1dmacro_stop_cont (void)
+{
+  if (l1_config.tmode.rf_params.down_up == TMODE_DOWNLINK)
+    l1dmacro_rx_down(STOP_RX_SNB);
+  else
+    l1dmacro_tx_down(l1_config.params.tx_nb_duration, FALSE, 0);
+}
+
+#endif/* */
+
+
+/*------------------------------------------*/
+/*             l1dmacro_reset_hw            */
+/*------------------------------------------*/
+/*      Reset and set OFFSET register       */
+/*------------------------------------------*/
+
+void l1dmacro_reset_hw(UWORD32 servingCellOffset)
+{
+   TPU_Reset(1); // reset TPU only, no TSP reset
+   TPU_Reset(0);
+   TP_Ptr = (UWORD16 *) TPU_RAM;
+
+   *TP_Ptr++ = TPU_MOVE(REG_SPI_ACT_U, TXM_SLEEP);
+   *TP_Ptr++ = TPU_MOVE(REG_SPI_ACT_L, TXM_SLEEP);
+   MOVE_REG_TSP_TO_RF(START_SCRIPT(DRP_IDLE),((UWORD16)( ((UWORD32)(&drp_regs->SCRIPT_STARTL))&0xFFFF)));
+
+   *TP_Ptr++ = TPU_OFFSET(servingCellOffset);
+
+}
+
+//  l1dmacro_RF_sleep
+//  Program RF for BIG or DEEP sleep
+
+
+void l1dmacro_RF_sleep  (void)
+{
+  // sending REG_OFF script
+   MOVE_REG_TSP_TO_RF(START_SCRIPT(DRP_REG_OFF), ((UWORD16)( ((UWORD32)(&drp_regs->SCRIPT_STARTL))&0xFFFF)));
+
+  *TP_Ptr++ = TPU_MOVE(REG_SPI_ACT_U, TXM_SLEEP);  //Shutdown FEM
+
+  *TP_Ptr++ = TPU_SLEEP;
+   TP_Ptr = (SYS_UWORD16 *) TPU_RAM;
+   TP_Enable(1);
+   TPU_wait_idle();
+
+}
+
+
+//  l1dmacro_RF_wakeup
+//* wakeup RF from BIG or DEEP sleep
+
+void l1dmacro_RF_wakeup  (void)
+{
+   // sending REG_ON script
+   MOVE_REG_TSP_TO_RF(START_SCRIPT(DRP_REG_ON), ((UWORD16)( ((UWORD32)(&drp_regs->SCRIPT_STARTL))&0xFFFF)));
+
+   *TP_Ptr++ = TPU_SLEEP;
+   TP_Ptr = (SYS_UWORD16 *) TPU_RAM;
+   TP_Enable(1);
+   TPU_wait_idle();
+
+
+}
+
+
+//              l1dmacro_init_hw
+//      Reset VEGA, then remove reset
+//      Init RF/IF synthesizers
+
+void l1dmacro_init_hw(void)
+{
+   WORD32 t = 100;    // start time for actions
+
+   TP_Reset(1); // reset TPU and TSP
+
+   // GSM 1.5 : TPU clock enable is in TPU
+   //---------------------------------------
+   TPU_ClkEnable(1);         // TPU CLOCK ON
+
+   TP_Reset(0);
+
+
+   TP_Ptr = (UWORD16 *) TPU_RAM;
+
+   // Set FEM to inactive state before turning ON the RF Board
+   // At this point the RF regulators are still OFF. Thus the
+   // FEM command is not inverted yet => Must use the FEM "SLEEP programming"
+
+
+   // TPU_SLEEP
+   l1dmacro_idle();
+
+   *TP_Ptr++ = TPU_AT(t);
+   *TP_Ptr++ = TPU_SYNC(0);
+
+	//Check Initialisation or Reset for TPU2OCP
+
+
+   *TP_Ptr++ = TPU_MOVE(REG_SPI_ACT_U, TXM_SLEEP);
+
+   t = 1000;      // arbitrary start time
+
+   t = rf_init(t); // Initialize RF Board
+
+   *TP_Ptr++ = TPU_AT(t);
+
+   // TPU_SLEEP
+   l1dmacro_idle();
+
+   return;
+}
+
+/*------------------------------------------*/
+/*         l1dmacro_init_hw_light           */
+/*------------------------------------------*/
+/*      Reset VEGA, then remove reset       */
+/*      Init RF/IF synthesizers             */
+/*------------------------------------------*/
+void l1dmacro_init_hw_light(void)
+{
+   UWORD32 t = 100;    // start time for actions //
+   TP_Ptr = (SYS_UWORD16 *) TPU_RAM; //
+   *TP_Ptr++ = TPU_AT(t);  //
+   t = 1000;      // arbitrary start time //
+
+   t = rf_init_light(t); // Initialize RF Board //
+
+   *TP_Ptr++ = TPU_AT(t); //
+   l1dmacro_idle(); //
+
+   return;
+}
+
+//BHO added
+/*
+ * l1dmacro_rx_fbsb
+ *
+ * Receive Frequency burst
+ */
+
+#if ((REL99 == 1) && (FF_BHO == 1))
+#if(L1_RF_KBD_FIX == 1)
+#if (L1_MADC_ON == 1)
+void l1dmacro_rx_fbsb (SYS_UWORD16 radio_freq, UWORD8 adc_active)
+#else
+void l1dmacro_rx_fbsb (SYS_UWORD16 radio_freq)
+#endif
+{
+#if (L1_MADC_ON == 1)
+  l1dmacro_rx_up(adc_active, L1_SAIC_HARDWARE_FILTER, L1_KBD_DIS_RX_FB
+	#if(NEW_SNR_THRESHOLD==1)
+		, SAIC_OFF
+	#endif
+		  );
+#else
+  l1dmacro_rx_up(L1_SAIC_HARDWARE_FILTER, L1_KBD_DIS_RX_FB);
+#endif
+
+
+  // same as rx_fb
+  *TP_Ptr++ = TPU_AT(0); //  1
+  *TP_Ptr++ = TPU_AT(0); //  2
+  *TP_Ptr++ = TPU_AT(0); //  3
+  *TP_Ptr++ = TPU_AT(0); //  4
+  *TP_Ptr++ = TPU_AT(0); //  5
+  *TP_Ptr++ = TPU_AT(0); //  6
+  *TP_Ptr++ = TPU_AT(0); //  7
+  *TP_Ptr++ = TPU_AT(0); //  8
+  *TP_Ptr++ = TPU_AT(0); //  9
+  *TP_Ptr++ = TPU_AT(0); //  10
+  *TP_Ptr++ = TPU_AT(0); //  11
+
+  // one more for SB
+  *TP_Ptr++ = TPU_AT(0); //  12
+
+  l1dmacro_rx_down (STOP_RX_FBSB);
+}
+#endif/*(L1_RF_KBD_FIX == 1)*/
+
+#if(L1_RF_KBD_FIX == 0)
+#if (L1_MADC_ON == 1)
+void l1dmacro_rx_fbsb (SYS_UWORD16 radio_freq, UWORD8 adc_active)
+#else
+void l1dmacro_rx_fbsb (SYS_UWORD16 radio_freq)
+#endif
+{
+#if (L1_MADC_ON == 1)
+  l1dmacro_rx_up(adc_active, L1_SAIC_HARDWARE_FILTER);
+#else
+  l1dmacro_rx_up(L1_SAIC_HARDWARE_FILTER);
+#endif
+
+  // same as rx_fb
+  *TP_Ptr++ = TPU_AT(0); //  1
+  *TP_Ptr++ = TPU_AT(0); //  2
+  *TP_Ptr++ = TPU_AT(0); //  3
+  *TP_Ptr++ = TPU_AT(0); //  4
+  *TP_Ptr++ = TPU_AT(0); //  5
+  *TP_Ptr++ = TPU_AT(0); //  6
+  *TP_Ptr++ = TPU_AT(0); //  7
+  *TP_Ptr++ = TPU_AT(0); //  8
+  *TP_Ptr++ = TPU_AT(0); //  9
+  *TP_Ptr++ = TPU_AT(0); //  10
+  *TP_Ptr++ = TPU_AT(0); //  11
+
+  // one more for SB
+  *TP_Ptr++ = TPU_AT(0); //  12
+
+  l1dmacro_rx_down (STOP_RX_FBSB);
+}
+#endif/*(L1_RF_KBD_FIX == 0)*/
+#endif // #if ((REL99 == 1) && (FF_BHO == 1))
+
+////BHO