FreeCalypso > hg > freecalypso-sw
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