freecalypso-citrine: L1/cfile/l1

author	Mychaela Falconia <falcon@freecalypso.org>
date	Thu, 09 Jun 2016 00:02:41 +0000
parents
children	b36540edb046

rev	line source
0 75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1 /*********** Revision Controle System Header ***********
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2 * GSM Layer 1 software
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	3 * L1_CTL.C
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	4 *
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	5 * Filename l1_ctl.c
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	6 * Copyright 2003 (C) Texas Instruments
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	7 *
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	8 *********** Revision Controle System Header ***********/
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	9
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	10 #define L1_CTL_C
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	11
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	12 #include "config.h"
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	13 #include "l1_confg.h"
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	14 #include "l1_macro.h"
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	15
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	16 #if (CODE_VERSION == SIMULATION)
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	17 #include <string.h>
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	18 #include "l1_types.h"
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	19 #include "sys_types.h"
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	20 #include "l1_const.h"
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	21 #include "l1_time.h"
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	22 #include "l1_signa.h"
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	23
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	24 #if TESTMODE
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	25 #include "l1tm_defty.h"
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	26 #endif
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	27 #if (AUDIO_TASK == 1)
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	28 #include "l1audio_const.h"
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	29 #include "l1audio_cust.h"
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	30 #include "l1audio_signa.h"
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	31 #include "l1audio_defty.h"
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	32 #include "l1audio_msgty.h"
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	33 #endif
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	34 #if (L1_GTT == 1)
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	35 #include "l1gtt_const.h"
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	36 #include "l1gtt_defty.h"
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	37 #endif
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	38 #if (L1_MP3 == 1)
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	39 #include "l1mp3_defty.h"
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	40 #endif
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	41 #if (L1_MIDI == 1)
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	42 #include "l1midi_defty.h"
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	43 #endif
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	44 //ADDED FOR AAC
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	45 #if (L1_AAC == 1)
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	46 #include "l1aac_defty.h"
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	47 #endif
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	48 #include "l1_defty.h"
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	49 #include "cust_os.h"
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	50 #include "l1_msgty.h"
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	51 #include "l1_varex.h"
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	52 #include "l1_proto.h"
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	53 #include "l1_mftab.h"
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	54 #include "l1_tabs.h"
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	55 #include "l1_ver.h"
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	56 #if L2_L3_SIMUL
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	57 #include "hw_debug.h"
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	58 #endif
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	59
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	60 #if TESTMODE
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	61 #include "l1tm_msgty.h"
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	62 #include "l1tm_varex.h"
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	63 #endif
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	64
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	65 #include "l1_ctl.h"
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	66
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	67 #ifdef _INLINE
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	68 #define INLINE static inline // Inline functions when -v option is set
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	69 #else // when the compiler is ivoked.
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	70 #define INLINE
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	71 #endif
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	72 #else
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	73 #include <string.h>
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	74 #include "l1_types.h"
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	75 #include "sys_types.h"
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	76 #include "l1_const.h"
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	77 #include "l1_time.h"
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	78 #include "l1_signa.h"
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	79
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	80 #if (RF_FAM == 61)
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	81 #include "tpudrv61.h"
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	82 #endif
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	83
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	84 #if TESTMODE
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	85 #include "l1tm_defty.h"
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	86 #endif
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	87 #if (AUDIO_TASK == 1)
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	88 #include "l1audio_const.h"
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	89 #include "l1audio_cust.h"
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	90 #include "l1audio_defty.h"
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	91 #endif
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	92 #if (L1_GTT == 1)
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	93 #include "l1gtt_const.h"
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	94 #include "l1gtt_defty.h"
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	95 #endif
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	96 #if (L1_MP3 == 1)
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	97 #include "l1mp3_defty.h"
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	98 #endif
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	99 #if (L1_MIDI == 1)
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	100 #include "l1midi_defty.h"
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	101 #endif
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	102 //ADDED FOR AAC
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	103 #if (L1_AAC == 1)
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	104 #include "l1aac_defty.h"
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	105 #endif
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	106 #include "l1_defty.h"
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	107 #include "../../gpf/inc/cust_os.h"
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	108 #include "l1_msgty.h"
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	109 #include "l1_varex.h"
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	110 #include "l1_proto.h"
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	111 #include "l1_tabs.h"
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	112 #include "l1_ctl.h"
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	113 #if L2_L3_SIMUL
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	114 #include "hw_debug.h"
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	115 #endif
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	116
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	117 #if TESTMODE
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	118 #include "l1tm_msgty.h"
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	119 #include "l1tm_varex.h"
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	120 #endif
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	121 #ifdef _INLINE
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	122 #define INLINE static inline // Inline functions when -v option is set
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	123 #else // when the compiler is ivoked.
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	124 #define INLINE
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	125 #endif
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	126 #endif
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	127
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	128 #if(RF_FAM == 61)
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	129 #include "l1_rf61.h"
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	130 #endif
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	131
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	132 #if (TRACE_TYPE == 1) \|\| (TRACE_TYPE == 4)
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	133 #include "l1_trace.h"
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	134 #endif
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	135
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	136 extern SYS_UWORD16 Convert_l1_radio_freq(SYS_UWORD16 radio_freq);
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	137 #if(RF_FAM == 61)
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	138 extern WORD16 drp_gain_correction(UWORD16 arfcn, UWORD8 lna_off, UWORD16 agc);
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	139 #endif
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	140
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	141 #define LNA_OFF 1
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	142 #define LNA_ON 0
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	143
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	144
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	145
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	146
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	147 /************************************/
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	148 /* Automatic frequency compensation */
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	149 /************************************/
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	150
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	151 #define L1_WORD16_POS_MAX (32767)
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	152 #define L1_WORD16_NEG_MAX (-32768)
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	153 #define L1_WORD32_POS_MAX ((unsigned long)(1<<31)-1)
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	154 #define L1_WORD32_NEG_MAX (-(unsigned long)(1<<31))
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	155
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	156 INLINE WORD16 Add_Sat_sign_16b(WORD16 val1, WORD16 val2)
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	157 {
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	158 WORD32 temp;
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	159 WORD16 result;
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	160
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	161 temp = (WORD32)((WORD32)val1 + (WORD32)val2);
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	162 if(temp > L1_WORD16_POS_MAX)
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	163 {
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	164 temp = L1_WORD16_POS_MAX;
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	165 }
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	166 if(temp < L1_WORD16_NEG_MAX)
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	167 {
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	168 temp = L1_WORD16_NEG_MAX;
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	169 }
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	170 result = (WORD16)((temp)&(0x0000FFFF));
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	171 return(result);
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	172 }
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	173
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	174 INLINE WORD32 Add_Sat_sign_32b(WORD32 val1, WORD32 val2)
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	175 {
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	176 WORD32 temp_high_high;
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	177 UWORD32 temp_low_low;
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	178 UWORD16 carry;
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	179 WORD32 result;
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	180 WORD16 high_val1, high_val2;
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	181 UWORD16 low_val1, low_val2;
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	182
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	183 high_val1 = (WORD16)(val1>>16);
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	184 high_val2 = (WORD16)(val2>>16);
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	185 low_val1 = (UWORD16)(val1&0x0000FFFF);
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	186 low_val2 = (UWORD16)(val2&0x0000FFFF);
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	187
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	188 temp_high_high = (WORD32)high_val1 + (WORD32)high_val2;
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	189 temp_low_low = (UWORD32)low_val1 + (UWORD32)low_val2;
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	190 carry = (UWORD16)(temp_low_low >> 16);
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	191 temp_high_high = temp_high_high + (UWORD32)(carry);
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	192
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	193
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	194 result = val1 + val2;
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	195 if(temp_high_high > L1_WORD16_POS_MAX)
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	196 {
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	197 result = L1_WORD32_POS_MAX;
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	198 }
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	199 if(temp_high_high < L1_WORD16_NEG_MAX)
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	200 {
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	201 result = L1_WORD32_NEG_MAX;
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	202 }
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	203
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	204 return(result);
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	205 }
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	206
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	207 INLINE WORD32 Sat_Mult_20sign_16unsign(WORD32 val1, UWORD32 val2)
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	208 {
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	209 WORD32 result;
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	210
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	211 result = val1 * val2;
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	212 if(val1>0) /* val2 is > 0*/
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	213 {
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	214 if(result < 0) /* overflow */
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	215 {
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	216 result = L1_WORD32_POS_MAX;
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	217 }
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	218 }
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	219 if(val1<0) /* val2 is > 0*/
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	220 {
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	221 if(result > 0) /* overflow */
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	222 {
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	223 result = L1_WORD32_NEG_MAX;
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	224 }
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	225 }
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	226 return(result);
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	227 }
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	228
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	229
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	230 INLINE WORD32 Add_40b( WORD32 guard1guard2, WORD32 lvar1, WORD32 lvar2, WORD16 *guardout )
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	231 {
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	232 WORD32 result, temp, carry, Lvar1, Lvar2;
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	233 WORD16 guard1,guard2;
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	234
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	235 guard1=(WORD16) ((WORD32) guard1guard2>>16);
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	236 guard2=(WORD16) guard1guard2;
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	237
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	238 /* lvar1 and lvar2 are both 48 bits variables */
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	239 /* We 1st add the low parts of lvar1 and lvar2 and we give */
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	240 /* a 32 bits result and a carry if needed */
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	241 Lvar1 = (UWORD16)lvar1;
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	242 Lvar2 = (UWORD16)lvar2;
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	243
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	244 temp = Lvar1 + Lvar2;
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	245
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	246 carry = temp >> 16;
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	247
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	248 result = temp & 0x0000ffffL;
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	249
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	250 /* We now add the two high parts of var1 and var2 (scaled */
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	251 /* to a 16 bits format) and carry (if any) and we give a */
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	252 /* 48 bits results. */
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	253 Lvar1 = (UWORD32)lvar1 >> 16;
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	254 Lvar2 = (UWORD32)lvar2 >> 16;
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	255
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	256 temp = Lvar1 + Lvar2 + carry;
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	257
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	258 carry = (UWORD32)temp >> 16;
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	259
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	260 temp = (UWORD32)temp << 16;
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	261
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	262 result = result \| temp;
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	263
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	264 temp = guard1 + guard2 + carry;
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	265
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	266 *guardout = (WORD16)temp;
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	267
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	268 return( result );
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	269 }
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	270
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	271
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	272 INLINE WORD32 Mult_40b(WORD32 var1, WORD16 var2, WORD16 *guardout)
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	273 {
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	274 WORD32 mult,guard1guard2;
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	275 WORD32 aux1;
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	276 UWORD32 aux2;
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	277 WORD16 neg_flag=0;
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	278 WORD32 var1_low_nosign,var2_nosign;
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	279
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	280 if (var2<0)
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	281 {
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	282 var2=-var2;
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	283 neg_flag=1;
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	284 }
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	285
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	286 /aux1 = AccHigh(var1)var2 */
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	287 aux1 = (WORD32)(var1>>16) * (WORD32)var2;
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	288 /* 16 bits * 16 bits -> 32 bits result */
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	289
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	290 /aux2 = AccLow(var1)var2 (unsigned multiplication) */
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	291 /* Performs the sign suppression of the words */
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	292 var1_low_nosign = (UWORD16)var1;
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	293 var2_nosign = (UWORD16) var2;
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	294
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	295 aux2 = (UWORD32)var1_low_nosign * (UWORD32)var2_nosign;
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	296
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	297 /Shift aux1=F48 of 16 bit left /
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	298 guard1guard2=aux1&0xFFFF0000L;/guard1=(WORD16)(aux1>>16)/
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	299 /guard2=0x0000 /
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	300 aux1=aux1<<16;
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	301
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	302
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	303 /* ((var1_highvar2)<<16) +(var1_lowvar2) = aux1 + aux2 */
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	304 /* aux1 and aux2 are both 48 bits variables */
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	305 /* We first add the low pats of aux1 and aux2 and we give*/
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	306 /* a 32 bits result and a carry if needed */
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	307 mult=Add_40b(guard1guard2,aux1,aux2,guardout );
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	308
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	309 if (neg_flag)
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	310 {
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	311 mult=-mult;
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	312 if (*guardout!=0)
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	313 guardout=-(guardout)-1;
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	314 else
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	315 *guardout=-1;
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	316 }
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	317
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	318 return(mult);
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	319 }
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	320
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	321
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	322 /***********************************************************************/
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	323 /* This function allows to multiply a WORD32 and a WORD16, both POSITIVE, */
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	324 /* variables. Result is WORD32. */
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	325 /***********************************************************************/
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	326 INLINE WORD32 UMult_40b(WORD32 var1, WORD16 var2, WORD16 *guardout)
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	327 {
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	328 WORD32 mult,guard1guard2;
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	329 UWORD32 aux1,aux2;
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	330 WORD32 var1_high_nosign,var1_low_nosign,var2_nosign;
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	331
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	332
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	333 /aux1 = AccHigh(var1)var2 (unsigned multiplication) */
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	334 /* Performs the sign suppression of the words */
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	335 var1_high_nosign = (UWORD32)var1>>16;
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	336 var2_nosign = (UWORD16) var2;
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	337
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	338 aux1 = (UWORD32)var1_high_nosign * (UWORD32)var2_nosign;
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	339
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	340 /aux2 = AccLow(var1)var2 (unsigned multiplication) */
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	341 /* Performs the sign suppression of the words */
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	342 var1_low_nosign = (WORD32)((UWORD16)var1);
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	343
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	344 aux2 = (UWORD32)var1_low_nosign * (UWORD32)var2_nosign;
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	345
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	346 /Shift aux1=F48 of 16 bit left /
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	347 guard1guard2=aux1&0xFFFF0000L;/guard1=(WORD16)(aux1>>16)/
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	348 /guard2=0x0000 /
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	349 aux1=aux1<<16;
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	350
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	351
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	352 /* ((var1_highvar2)<<16) +(var1_lowvar2) = aux1 + aux2 */
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	353 mult=Add_40b(guard1guard2,aux1,aux2,guardout);
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	354
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	355 return(mult);
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	356 }
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	357
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	358
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	359 /-------------------------------------------------------/
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	360 /* l1ctl_afc() */
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	361 /-------------------------------------------------------/
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	362 /* Parameters : */
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	363 /* Return : */
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	364 /* Functionality : */
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	365 /-------------------------------------------------------/
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	366 #if (VCXO_ALGO == 0)
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	367 WORD16 l1ctl_afc (UWORD8 phase, UWORD32 *frame_count, WORD16 angle, WORD32 snr, UWORD16 radio_freq)
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	368 #else
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	369 WORD16 l1ctl_afc (UWORD8 phase, UWORD32 *frame_count, WORD16 angle, WORD32 snr, UWORD16 radio_freq, UWORD32 l1_mode)
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	370 #endif
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	371 {
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	372 /*************************/
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	373 /* Variables declaration */
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	374 /*************************/
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	375 WORD16 i=0;
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	376 UWORD32 denom; /* F12.20 */
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	377 WORD32 var_32,num,Phi_32=0,var1,var2,guard1guard2;
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	378 static UWORD32 P=C_cov_start; /* F12.20 */
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	379 static WORD32 Psi=0; /* F13.19 */
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	380 static WORD16 Psi_quant[C_N_del+1]; /* F13.3 */
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	381 WORD16 var_16;
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	382 WORD16 Phi=0; /* F1.15 */
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	383 WORD16 quotient,guard1,guard2,guardout;
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	384 UWORD32 LGuard;
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	385 WORD16 denomH,denomH_3msb;
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	386 UWORD32 K=0; /* algo 1 */
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	387
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	388 static WORD16 old_Psi_quant[C_N_del+1];
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	389 static WORD32 old_Psi=0;
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	390
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	391 #if (VCXO_ALGO == 1)
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	392 static WORD32 psi_past[C_N_del+1]; /* F13.19 */
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	393 static WORD16 psi_quant; /* F13.3 */
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	394 static WORD16 quant_avg;
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	395 static UWORD32 M_Count;
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	396 static WORD32 psi_avg[C_PSI_AVG_SIZE_D+1]; // Data history array
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	397 static WORD16 B_Count; // Counter for consecutive SNR below C_thr_snr
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	398 UWORD16 L = 10433; // Gain algo2
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	399 static UWORD16 first_avg;
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	400 static UWORD16 good_snr;
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	401
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	402 /* to be able to keep in memory the old AFC variables in case of spurious
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	403 FB detection */
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	404 static WORD32 old_psi_past[C_N_del+1]; /* F13.19 */
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	405 static WORD16 old_psi_quant; /* F13.3 */
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	406
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	407 #endif
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	408 #if (L1_FF_MULTIBAND == 1)
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	409 UWORD8 physical_band_id;
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	410 #endif
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	411
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	412
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	413 //Set AFC close loop gain for ALGO_AFC_LQG_PREDICTOR.
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	414 if(l1_mode==I_MODE)//MS is in Idle mode
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	415 L = 41732; //F0.20 L=41732/2^20 = 0.04
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	416 else //All other modes than Idle
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	417 L = 10433; //F0.20 L=10433/2^20 = 0.01
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	418
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	419
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	420 #if (L1_FF_MULTIBAND == 0)
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	421
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	422 if (((l1_config.std.id == DUAL) \|\| (l1_config.std.id == DUALEXT) \|\| (l1_config.std.id == DUAL_US)) &&
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	423 #if (VCXO_ALGO == 1)
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	424 ((phase != AFC_INIT_CENTER) \|\| (phase != AFC_INIT_MIN) \|\| (phase != AFC_INIT_MAX)))
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	425 #else
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	426 (phase != AFC_INIT))
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	427 #endif
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	428 {
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	429 if (radio_freq >= l1_config.std.first_radio_freq_band2)
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	430 {
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	431 angle = (angle + 1) >> 1;
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	432 }
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	433 }
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	434
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	435 else if (((l1_config.std.id == DCS1800) \|\| (l1_config.std.id == PCS1900)) &&
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	436 #if (VCXO_ALGO == 1)
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	437 ((phase != AFC_INIT_CENTER) \|\| (phase != AFC_INIT_MIN) \|\| (phase != AFC_INIT_MAX)))
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	438 #else
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	439 (phase != AFC_INIT))
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	440 #endif
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	441 {
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	442 angle = (angle + 1) >> 1;
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	443 }
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	444
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	445 #else // L1_FF_MULTIBAND = 1 below
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	446
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	447 #if (VCXO_ALGO == 1)
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	448 if((phase != AFC_INIT_CENTER) \|\| (phase != AFC_INIT_MIN) \|\| (phase != AFC_INIT_MAX))
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	449 #else
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	450 if(phase != AFC_INIT)
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	451 #endif
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	452 {
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	453 physical_band_id = l1_multiband_radio_freq_convert_into_physical_band_id(radio_freq);
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	454
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	455 if( (multiband_rf[physical_band_id].gsm_band_identifier == DCS1800) \|\| (multiband_rf[physical_band_id].gsm_band_identifier == PCS1900))
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	456 {
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	457 angle = (angle + 1) >> 1;
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	458 }
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	459 }
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	460
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	461 #endif // #if (L1_FF_MULTIBAND == 1) else
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	462
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	463
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	464
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	465 /*********************************/
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	466 /* frequency offset compensation */
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	467 /*********************************/
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	468 /* Initialization */
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	469
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	470 #if (VCXO_ALGO == 1)
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	471 switch (l1_config.params.afc_algo)
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	472 {
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	473
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	474 /* algo1 only: */
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	475 case ALGO_AFC_KALMAN:
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	476 {
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	477 #endif
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	478 #if (VCXO_ALGO == 0)
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	479 if (phase==AFC_INIT)
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	480 {
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	481 // WARNING
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	482 // In this case, "angle" variable contains EEPROM_AFC initialization value
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	483 // directly loaded from EEPROM, and "snr" variable is not meaningful.
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	484 /* Static variables initialisation */
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	485 P=C_cov_start;
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	486 Psi=0;
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	487 if (angle>C_max_step)
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	488 Psi_quant[C_N_del]=C_max_step;
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	489 else
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	490 if(angle<C_min_step)
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	491 Psi_quant[C_N_del]=C_min_step;
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	492 else Psi_quant[C_N_del]=angle;
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	493
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	494 Psi=l1_config.params.psi_stPsi_quant[C_N_del]; / F0.16 * F13.3 = F13.19 */
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	495 } /* end AFC_INIT*/
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	496 else
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	497 {
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	498 if (phase==AFC_OPEN_LOOP)
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	499 {
75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	500 /* delay line for Psi_quant values */

0

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1 /************* Revision Controle System Header *************

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2 * GSM Layer 1 software

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

3 * L1_CTL.C

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

4 *

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

5 * Filename l1_ctl.c

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

7 *

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

8 ************* Revision Controle System Header *************/

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

9

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

10 #define L1_CTL_C

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

11

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

12 #include "config.h"

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

13 #include "l1_confg.h"

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

14 #include "l1_macro.h"

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

15

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

16 #if (CODE_VERSION == SIMULATION)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

17 #include <string.h>

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

18 #include "l1_types.h"

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

19 #include "sys_types.h"

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

20 #include "l1_const.h"

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

21 #include "l1_time.h"

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

22 #include "l1_signa.h"

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

23

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

24 #if TESTMODE

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

25 #include "l1tm_defty.h"

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

26 #endif

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

27 #if (AUDIO_TASK == 1)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

28 #include "l1audio_const.h"

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

29 #include "l1audio_cust.h"

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

30 #include "l1audio_signa.h"

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

31 #include "l1audio_defty.h"

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

32 #include "l1audio_msgty.h"

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

33 #endif

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

34 #if (L1_GTT == 1)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

35 #include "l1gtt_const.h"

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

36 #include "l1gtt_defty.h"

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

37 #endif

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

38 #if (L1_MP3 == 1)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

39 #include "l1mp3_defty.h"

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

40 #endif

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

41 #if (L1_MIDI == 1)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

42 #include "l1midi_defty.h"

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

43 #endif

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

44 //ADDED FOR AAC

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

45 #if (L1_AAC == 1)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

46 #include "l1aac_defty.h"

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

47 #endif

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

48 #include "l1_defty.h"

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

49 #include "cust_os.h"

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

50 #include "l1_msgty.h"

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

51 #include "l1_varex.h"

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

52 #include "l1_proto.h"

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

53 #include "l1_mftab.h"

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

54 #include "l1_tabs.h"

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

55 #include "l1_ver.h"

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

56 #if L2_L3_SIMUL

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

57 #include "hw_debug.h"

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

58 #endif

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

59

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

60 #if TESTMODE

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

61 #include "l1tm_msgty.h"

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

62 #include "l1tm_varex.h"

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

63 #endif

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

64

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

65 #include "l1_ctl.h"

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

66

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

67 #ifdef _INLINE

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

68 #define INLINE static inline // Inline functions when -v option is set

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

69 #else // when the compiler is ivoked.

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

70 #define INLINE

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

71 #endif

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

72 #else

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

73 #include <string.h>

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

74 #include "l1_types.h"

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

75 #include "sys_types.h"

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

76 #include "l1_const.h"

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

77 #include "l1_time.h"

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

78 #include "l1_signa.h"

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

79

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

80 #if (RF_FAM == 61)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

81 #include "tpudrv61.h"

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

82 #endif

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

83

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

84 #if TESTMODE

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

85 #include "l1tm_defty.h"

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

86 #endif

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

87 #if (AUDIO_TASK == 1)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

88 #include "l1audio_const.h"

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

89 #include "l1audio_cust.h"

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

90 #include "l1audio_defty.h"

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

91 #endif

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

92 #if (L1_GTT == 1)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

93 #include "l1gtt_const.h"

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

94 #include "l1gtt_defty.h"

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

95 #endif

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

96 #if (L1_MP3 == 1)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

97 #include "l1mp3_defty.h"

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

98 #endif

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

99 #if (L1_MIDI == 1)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

100 #include "l1midi_defty.h"

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

101 #endif

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

102 //ADDED FOR AAC

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

103 #if (L1_AAC == 1)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

104 #include "l1aac_defty.h"

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

105 #endif

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

106 #include "l1_defty.h"

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

107 #include "../../gpf/inc/cust_os.h"

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

108 #include "l1_msgty.h"

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

109 #include "l1_varex.h"

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

110 #include "l1_proto.h"

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

111 #include "l1_tabs.h"

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

112 #include "l1_ctl.h"

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

113 #if L2_L3_SIMUL

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

114 #include "hw_debug.h"

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

115 #endif

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

116

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

117 #if TESTMODE

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

118 #include "l1tm_msgty.h"

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

119 #include "l1tm_varex.h"

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

120 #endif

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

121 #ifdef _INLINE

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

122 #define INLINE static inline // Inline functions when -v option is set

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

123 #else // when the compiler is ivoked.

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

124 #define INLINE

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

125 #endif

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

126 #endif

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

127

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

128 #if(RF_FAM == 61)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

129 #include "l1_rf61.h"

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

130 #endif

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

131

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

132 #if (TRACE_TYPE == 1) || (TRACE_TYPE == 4)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

133 #include "l1_trace.h"

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

134 #endif

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

135

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

136 extern SYS_UWORD16 Convert_l1_radio_freq(SYS_UWORD16 radio_freq);

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

137 #if(RF_FAM == 61)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

138 extern WORD16 drp_gain_correction(UWORD16 arfcn, UWORD8 lna_off, UWORD16 agc);

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

139 #endif

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

140

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

141 #define LNA_OFF 1

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

142 #define LNA_ON 0

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

143

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

144

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

145

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

146

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

147 /************************************/

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

148 /* Automatic frequency compensation */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

149 /************************************/

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

150

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

151 #define L1_WORD16_POS_MAX (32767)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

152 #define L1_WORD16_NEG_MAX (-32768)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

153 #define L1_WORD32_POS_MAX ((unsigned long)(1<<31)-1)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

154 #define L1_WORD32_NEG_MAX (-(unsigned long)(1<<31))

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

155

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

156 INLINE WORD16 Add_Sat_sign_16b(WORD16 val1, WORD16 val2)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

157 {

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

158 WORD32 temp;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

159 WORD16 result;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

160

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

161 temp = (WORD32)((WORD32)val1 + (WORD32)val2);

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

162 if(temp > L1_WORD16_POS_MAX)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

163 {

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

164 temp = L1_WORD16_POS_MAX;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

165 }

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

166 if(temp < L1_WORD16_NEG_MAX)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

167 {

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

168 temp = L1_WORD16_NEG_MAX;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

169 }

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

170 result = (WORD16)((temp)&(0x0000FFFF));

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

171 return(result);

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

172 }

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

173

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

174 INLINE WORD32 Add_Sat_sign_32b(WORD32 val1, WORD32 val2)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

175 {

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

176 WORD32 temp_high_high;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

177 UWORD32 temp_low_low;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

178 UWORD16 carry;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

179 WORD32 result;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

180 WORD16 high_val1, high_val2;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

181 UWORD16 low_val1, low_val2;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

182

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

183 high_val1 = (WORD16)(val1>>16);

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

184 high_val2 = (WORD16)(val2>>16);

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

185 low_val1 = (UWORD16)(val1&0x0000FFFF);

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

186 low_val2 = (UWORD16)(val2&0x0000FFFF);

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

187

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

188 temp_high_high = (WORD32)high_val1 + (WORD32)high_val2;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

189 temp_low_low = (UWORD32)low_val1 + (UWORD32)low_val2;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

190 carry = (UWORD16)(temp_low_low >> 16);

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

191 temp_high_high = temp_high_high + (UWORD32)(carry);

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

192

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

193

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

194 result = val1 + val2;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

195 if(temp_high_high > L1_WORD16_POS_MAX)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

196 {

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

197 result = L1_WORD32_POS_MAX;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

198 }

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

199 if(temp_high_high < L1_WORD16_NEG_MAX)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

200 {

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

201 result = L1_WORD32_NEG_MAX;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

202 }

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

203

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

204 return(result);

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

205 }

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

206

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

207 INLINE WORD32 Sat_Mult_20sign_16unsign(WORD32 val1, UWORD32 val2)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

208 {

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

209 WORD32 result;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

210

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

211 result = val1 * val2;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

212 if(val1>0) /* val2 is > 0*/

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

213 {

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

214 if(result < 0) /* overflow */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

215 {

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

216 result = L1_WORD32_POS_MAX;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

217 }

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

218 }

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

219 if(val1<0) /* val2 is > 0*/

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

220 {

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

221 if(result > 0) /* overflow */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

222 {

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

223 result = L1_WORD32_NEG_MAX;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

224 }

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

225 }

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

226 return(result);

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

227 }

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

228

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

229

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

230 INLINE WORD32 Add_40b( WORD32 guard1guard2, WORD32 lvar1, WORD32 lvar2, WORD16 *guardout )

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

231 {

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

232 WORD32 result, temp, carry, Lvar1, Lvar2;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

233 WORD16 guard1,guard2;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

234

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

235 guard1=(WORD16) ((WORD32) guard1guard2>>16);

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

236 guard2=(WORD16) guard1guard2;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

237

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

238 /* lvar1 and lvar2 are both 48 bits variables */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

239 /* We 1st add the low parts of lvar1 and lvar2 and we give */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

240 /* a 32 bits result and a carry if needed */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

241 Lvar1 = (UWORD16)lvar1;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

242 Lvar2 = (UWORD16)lvar2;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

243

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

244 temp = Lvar1 + Lvar2;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

245

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

246 carry = temp >> 16;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

247

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

248 result = temp & 0x0000ffffL;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

249

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

250 /* We now add the two high parts of var1 and var2 (scaled */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

251 /* to a 16 bits format) and carry (if any) and we give a */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

252 /* 48 bits results. */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

253 Lvar1 = (UWORD32)lvar1 >> 16;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

254 Lvar2 = (UWORD32)lvar2 >> 16;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

255

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

256 temp = Lvar1 + Lvar2 + carry;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

257

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

258 carry = (UWORD32)temp >> 16;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

259

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

260 temp = (UWORD32)temp << 16;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

261

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

262 result = result | temp;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

263

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

264 temp = guard1 + guard2 + carry;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

265

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

266 *guardout = (WORD16)temp;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

267

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

268 return( result );

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

269 }

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

270

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

271

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

272 INLINE WORD32 Mult_40b(WORD32 var1, WORD16 var2, WORD16 *guardout)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

273 {

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

274 WORD32 mult,guard1guard2;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

275 WORD32 aux1;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

276 UWORD32 aux2;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

277 WORD16 neg_flag=0;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

278 WORD32 var1_low_nosign,var2_nosign;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

279

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

280 if (var2<0)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

281 {

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

282 var2=-var2;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

283 neg_flag=1;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

284 }

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

285

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

286 /*aux1 = AccHigh(var1)*var2 */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

287 aux1 = (WORD32)(var1>>16) * (WORD32)var2;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

288 /* 16 bits * 16 bits -> 32 bits result */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

289

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

290 /*aux2 = AccLow(var1)*var2 (unsigned multiplication) */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

291 /* Performs the sign suppression of the words */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

292 var1_low_nosign = (UWORD16)var1;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

293 var2_nosign = (UWORD16) var2;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

294

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

295 aux2 = (UWORD32)var1_low_nosign * (UWORD32)var2_nosign;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

296

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

297 /*Shift aux1=F48 of 16 bit left */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

298 guard1guard2=aux1&0xFFFF0000L;/*guard1=(WORD16)(aux1>>16)*/

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

299 /*guard2=0x0000 */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

300 aux1=aux1<<16;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

301

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

302

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

303 /* ((var1_high*var2)<<16) +(var1_low*var2) = aux1 + aux2 */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

304 /* aux1 and aux2 are both 48 bits variables */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

305 /* We first add the low pats of aux1 and aux2 and we give*/

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

306 /* a 32 bits result and a carry if needed */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

307 mult=Add_40b(guard1guard2,aux1,aux2,guardout );

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

308

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

309 if (neg_flag)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

310 {

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

311 mult=-mult;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

312 if (*guardout!=0)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

313 *guardout=-(*guardout)-1;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

314 else

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

315 *guardout=-1;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

316 }

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

317

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

318 return(mult);

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

319 }

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

320

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

321

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

322 /***********************************************************************/

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

323 /* This function allows to multiply a WORD32 and a WORD16, both POSITIVE, */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

324 /* variables. Result is WORD32. */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

325 /***********************************************************************/

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

326 INLINE WORD32 UMult_40b(WORD32 var1, WORD16 var2, WORD16 *guardout)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

327 {

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

328 WORD32 mult,guard1guard2;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

329 UWORD32 aux1,aux2;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

330 WORD32 var1_high_nosign,var1_low_nosign,var2_nosign;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

331

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

332

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

333 /*aux1 = AccHigh(var1)*var2 (unsigned multiplication) */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

334 /* Performs the sign suppression of the words */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

335 var1_high_nosign = (UWORD32)var1>>16;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

336 var2_nosign = (UWORD16) var2;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

337

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

338 aux1 = (UWORD32)var1_high_nosign * (UWORD32)var2_nosign;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

339

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

340 /*aux2 = AccLow(var1)*var2 (unsigned multiplication) */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

341 /* Performs the sign suppression of the words */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

342 var1_low_nosign = (WORD32)((UWORD16)var1);

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

343

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

344 aux2 = (UWORD32)var1_low_nosign * (UWORD32)var2_nosign;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

345

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

346 /*Shift aux1=F48 of 16 bit left */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

347 guard1guard2=aux1&0xFFFF0000L;/*guard1=(WORD16)(aux1>>16)*/

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

348 /*guard2=0x0000 */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

349 aux1=aux1<<16;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

350

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

351

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

352 /* ((var1_high*var2)<<16) +(var1_low*var2) = aux1 + aux2 */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

353 mult=Add_40b(guard1guard2,aux1,aux2,guardout);

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

354

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

355 return(mult);

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

356 }

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

357

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

358

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

359 /*-------------------------------------------------------*/

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

360 /* l1ctl_afc() */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

361 /*-------------------------------------------------------*/

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

362 /* Parameters : */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

363 /* Return : */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

364 /* Functionality : */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

365 /*-------------------------------------------------------*/

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

366 #if (VCXO_ALGO == 0)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

367 WORD16 l1ctl_afc (UWORD8 phase, UWORD32 *frame_count, WORD16 angle, WORD32 snr, UWORD16 radio_freq)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

368 #else

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

369 WORD16 l1ctl_afc (UWORD8 phase, UWORD32 *frame_count, WORD16 angle, WORD32 snr, UWORD16 radio_freq, UWORD32 l1_mode)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

370 #endif

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

371 {

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

372 /*************************/

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

373 /* Variables declaration */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

374 /*************************/

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

375 WORD16 i=0;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

376 UWORD32 denom; /* F12.20 */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

377 WORD32 var_32,num,Phi_32=0,var1,var2,guard1guard2;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

378 static UWORD32 P=C_cov_start; /* F12.20 */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

379 static WORD32 Psi=0; /* F13.19 */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

380 static WORD16 Psi_quant[C_N_del+1]; /* F13.3 */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

381 WORD16 var_16;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

382 WORD16 Phi=0; /* F1.15 */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

383 WORD16 quotient,guard1,guard2,guardout;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

384 UWORD32 LGuard;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

385 WORD16 denomH,denomH_3msb;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

386 UWORD32 K=0; /* algo 1 */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

387

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

388 static WORD16 old_Psi_quant[C_N_del+1];

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

389 static WORD32 old_Psi=0;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

390

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

391 #if (VCXO_ALGO == 1)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

392 static WORD32 psi_past[C_N_del+1]; /* F13.19 */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

393 static WORD16 psi_quant; /* F13.3 */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

394 static WORD16 quant_avg;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

395 static UWORD32 M_Count;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

396 static WORD32 psi_avg[C_PSI_AVG_SIZE_D+1]; // Data history array

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

397 static WORD16 B_Count; // Counter for consecutive SNR below C_thr_snr

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

398 UWORD16 L = 10433; // Gain algo2

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

399 static UWORD16 first_avg;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

400 static UWORD16 good_snr;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

401

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

402 /* to be able to keep in memory the old AFC variables in case of spurious

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

403 FB detection */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

404 static WORD32 old_psi_past[C_N_del+1]; /* F13.19 */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

405 static WORD16 old_psi_quant; /* F13.3 */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

406

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

407 #endif

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

408 #if (L1_FF_MULTIBAND == 1)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

409 UWORD8 physical_band_id;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

410 #endif

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

411

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

412

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

413 //Set AFC close loop gain for ALGO_AFC_LQG_PREDICTOR.

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

414 if(l1_mode==I_MODE)//MS is in Idle mode

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

415 L = 41732; //F0.20 L=41732/2^20 = 0.04

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

416 else //All other modes than Idle

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

417 L = 10433; //F0.20 L=10433/2^20 = 0.01

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

418

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

419

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

420 #if (L1_FF_MULTIBAND == 0)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

421

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

422 if (((l1_config.std.id == DUAL) || (l1_config.std.id == DUALEXT) || (l1_config.std.id == DUAL_US)) &&

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

423 #if (VCXO_ALGO == 1)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

424 ((phase != AFC_INIT_CENTER) || (phase != AFC_INIT_MIN) || (phase != AFC_INIT_MAX)))

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

425 #else

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

426 (phase != AFC_INIT))

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

427 #endif

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

428 {

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

429 if (radio_freq >= l1_config.std.first_radio_freq_band2)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

430 {

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

431 angle = (angle + 1) >> 1;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

432 }

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

433 }

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

434

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

435 else if (((l1_config.std.id == DCS1800) || (l1_config.std.id == PCS1900)) &&

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

436 #if (VCXO_ALGO == 1)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

437 ((phase != AFC_INIT_CENTER) || (phase != AFC_INIT_MIN) || (phase != AFC_INIT_MAX)))

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

438 #else

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

439 (phase != AFC_INIT))

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

440 #endif

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

441 {

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

442 angle = (angle + 1) >> 1;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

443 }

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

444

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

445 #else // L1_FF_MULTIBAND = 1 below

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

446

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

447 #if (VCXO_ALGO == 1)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

448 if((phase != AFC_INIT_CENTER) || (phase != AFC_INIT_MIN) || (phase != AFC_INIT_MAX))

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

449 #else

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

450 if(phase != AFC_INIT)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

451 #endif

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

452 {

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

453 physical_band_id = l1_multiband_radio_freq_convert_into_physical_band_id(radio_freq);

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

454

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

455 if( (multiband_rf[physical_band_id].gsm_band_identifier == DCS1800) || (multiband_rf[physical_band_id].gsm_band_identifier == PCS1900))

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

456 {

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

457 angle = (angle + 1) >> 1;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

458 }

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

459 }

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

460

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

461 #endif // #if (L1_FF_MULTIBAND == 1) else

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

462

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

463

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

464

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

465 /*********************************/

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

466 /* frequency offset compensation */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

467 /*********************************/

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

468 /* Initialization */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

469

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

470 #if (VCXO_ALGO == 1)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

471 switch (l1_config.params.afc_algo)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

472 {

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

473

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

474 /* algo1 only: */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

475 case ALGO_AFC_KALMAN:

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

476 {

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

477 #endif

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

478 #if (VCXO_ALGO == 0)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

479 if (phase==AFC_INIT)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

480 {

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

481 // WARNING

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

482 // In this case, "angle" variable contains EEPROM_AFC initialization value

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

483 // directly loaded from EEPROM, and "snr" variable is not meaningful.

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

484 /* Static variables initialisation */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

485 P=C_cov_start;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

486 Psi=0;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

487 if (angle>C_max_step)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

488 Psi_quant[C_N_del]=C_max_step;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

489 else

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

490 if(angle<C_min_step)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

491 Psi_quant[C_N_del]=C_min_step;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

492 else Psi_quant[C_N_del]=angle;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

493

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

494 Psi=l1_config.params.psi_st*Psi_quant[C_N_del]; /* F0.16 * F13.3 = F13.19 */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

495 } /* end AFC_INIT*/

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

496 else

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

497 {

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

498 if (phase==AFC_OPEN_LOOP)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

499 {

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

500 /* delay line for Psi_quant values */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

501 for (i=1;i<=C_N_del;i++)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

502 Psi_quant[i-1]=Psi_quant[i];

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

503

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

504 var_32=(WORD32)((WORD32)angle*l1_config.params.psi_sta_inv)<<4;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

505 /*(F16.0 * F1.15 = F17.15) << 4 = F13.19 */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

506

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

507 #if(RF_FAM == 61)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

508 /* In order to implement the NINT function for a F16.0, we check */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

509 /* if var_32 + 0.5*2**18 is a multiple of 2**18 */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

510 quotient=(WORD16)((WORD32)(((WORD32)(var_32+(1<<17)))/(1<<18)));

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

511 var_16=quotient*4;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

512 #else

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

513 /* In order to implement the NINT function for a F16.0, we check */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

514 /* if var_32 + 0.5*2**19 is a multiple of 2**19 */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

515 quotient=(WORD16)((WORD32)(((WORD32)(var_32+(1<<18)))/(1<<19)));

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

516 var_16=quotient*8;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

517 #endif

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

518 if (var_16>C_max_step)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

519 Psi_quant[C_N_del]=Add_Sat_sign_16b(Psi_quant[C_N_del],C_max_step);

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

520 else

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

521 if(var_16<C_min_step)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

522 Psi_quant[C_N_del]=Add_Sat_sign_16b(Psi_quant[C_N_del],C_min_step);

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

523 else Psi_quant[C_N_del]=Add_Sat_sign_16b(Psi_quant[C_N_del],var_16); /* F13.3 */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

524

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

525 Psi=l1_config.params.psi_st*Psi_quant[C_N_del]; /* F0.16 * F13.3 = F13.19 */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

526 }/*end if AFC_OPEN_LOOP*/

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

527

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

528 else

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

529 {

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

530 /* delay line for Psi_quant values */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

531 for (i=1;i<=C_N_del;i++)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

532 Psi_quant[i-1]=Psi_quant[i];

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

533

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

534 /********************/

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

535 /* Filter algorithm */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

536 /********************/

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

537

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

538 /* Covariance error is increased of C_Q */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

539 P=P+(*frame_count)*C_Q;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

540

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

541 /* Clipping of P */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

542 if (P>C_thr_P) P=C_thr_P;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

543

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

544 if (snr>=C_thr_snr)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

545 {

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

546 /* Clipping of error angle */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

547 if (angle>C_thr_phi)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

548 angle=C_thr_phi;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

549 if (angle<-C_thr_phi)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

550 angle=-C_thr_phi;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

551

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

552 /* Kalman gain */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

553 /*K=P*(1/(P+C_a0_kalman+(C_g_kalman*RNS))) */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

554 /*C_a0_kalman=0.01 */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

555 /*C_g_kalman =0.05 */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

556 num=(C_g_kalman/snr)+P+C_a0_kalman;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

557 /* (F2.30 / F6.10) = F 12.20 */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

558

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

559 /* denom = P << 19 = F 1.39 */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

560 /* extension of denom=P to a 40 bits variable */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

561 /* denom (F12.20) << 16 = F 4.36 */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

562 guard1=(WORD16)((WORD32)P>>16);

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

563 /* denom = P<<16 = (F4.36) << 3 = F 1.39 */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

564 denomH=(UWORD16)P;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

565 /* Low part of denom is equal to 0, because P has been 16 */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

566 /* bits left shifted previously. */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

567 denomH_3msb=(denomH>>13)&0x0007;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

568 guard1=(guard1<<3)|denomH_3msb;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

569 denomH<<=3;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

570 denom=(UWORD32)denomH<<16;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

571 /* num + guard1 are a 40 bits representation of P */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

572 /* In order to compute P(F1.39)/num, we sample P in guard1 */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

573 /* (scaled to a 32 bits number) and num (32 bits number) */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

574 /* K = ((guard1<<24)/num)<<8 + (denom/num) */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

575 var1=(WORD32)guard1<<24;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

576 var1=var1/num;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

577 var1=(WORD32)var1<<8;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

578 /* var2 is an unsigned variable, var1 contains signed guard*/

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

579 /* bits. */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

580 var2=denom/num;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

581 K = (var1+var2)<<1; /* F1.39 / F12.20 = F13.19 */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

582 /* F13.19 << 1 = F12.20 */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

583

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

584 /* Clipping of the Kalman gain */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

585 if (K>=C_thr_K)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

586 K=C_thr_K;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

587

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

588 /*******************************************************/

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

589 /* P=(1-K)*P = 0.8 * 0.5 at maximum */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

590 /*******************************************************/

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

591 /* Perform a positive variable F12.20 multiplication by*/

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

592 /* positive variable F12.20 */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

593 var_16=(WORD16)(1048576L-K); /* acclow(1-K) = F12.20 */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

594 guard1=0; /* positive variable */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

595 var1=UMult_40b(P,var_16,&guard1);

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

596 var_16=(WORD16)((1048576L-K)>>16);

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

597 /* acchigh(1-K) = F12.20 */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

598 var2=P*var_16; /* var2 = 0x80000 * 0xc */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

599 /* at maximum, so result */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

600 /* is 32 bits WORD32 and */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

601 /* equal 0x600000 */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

602 /* extension of var2 to a 40 bits variable : var2<<16 */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

603 guard2=(WORD16)((WORD32)var2>>16);

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

604 guard1guard2=((WORD32)guard1<<16) |((WORD32) guard2&0x0000FFFFL);

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

605 var2=var2<<16;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

606 var_32=Add_40b(guard1guard2,var1,var2,&guardout);

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

607 /* var_32 (F8.40) >> 16 = F8.24 */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

608 LGuard=(WORD32)guardout<<16;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

609 var1=(UWORD32)var_32>>16;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

610 /* var_32 >> 4 = F12.20 */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

611 P=(var1+LGuard)>>4;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

612

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

613 Phi_32=Mult_40b(l1_config.params.psi_st_32,Psi_quant[0],&guardout);

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

614 /* F0.32 * F13.3 = F5.35 */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

615 LGuard=(WORD32)guardout<<16; /* var_32 (F5.35) >> 16 */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

616 /* F13.19 */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

617 var1=(UWORD32)Phi_32>>16;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

618 Phi_32=Psi-(LGuard+var1); /* F13.19 */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

619

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

620 /*Phi=angle-Phi_32*/

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

621 Phi_32=((WORD32)angle<<4)-Phi_32;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

622 /* F1.15 * 4 = F13.19 */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

623 Phi=(WORD16)(Phi_32>>4); /* F17.15 */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

624 /*var1=K*Phi F12.20 * F1.15 = 13.35 */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

625 guard1=0;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

626 var1=Mult_40b(K,Phi,&guard1);

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

627 /* var1 (F13.35) >> 16 */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

628 /* F13.19 */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

629 LGuard=(WORD32)guard1<<16;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

630 var1=(UWORD32)var1>>16;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

631 Psi+=var1+LGuard;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

632 }/*if snr */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

633

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

634 var_32=Mult_40b(Psi,l1_config.params.psi_st_inv,&guardout);

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

635 /* F13.19 * C = F13.19 */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

636

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

637 #if(RF_FAM == 61)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

638 /* In order to implement the NINT function for a F13.3, we check */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

639 /* if var_32 + 0.5*2**18 is a multiple of 2**18 */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

640 quotient=(WORD16)((WORD32)(((WORD32)(var_32+(1<<17)))/(1<<18)));

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

641 var_16=quotient*4;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

642 #else

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

643 /* In order to implement the NINT function for a F13.3, we check */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

644 /* if var_32 + 0.5*2**19 is a multiple of 2**19 */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

645 quotient=(WORD16)((WORD32)(((WORD32)(var_32+(1<<18)))/(1<<19)));

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

646 var_16=quotient*8;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

647 #endif

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

648 if (var_16>C_max_step)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

649 Psi_quant[C_N_del]=C_max_step;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

650 else

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

651 if(var_16<C_min_step)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

652 Psi_quant[C_N_del]=C_min_step;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

653 else Psi_quant[C_N_del]=var_16; /* F13.3 */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

654

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

655 }/*end AFC_CLOSE_LOOP*/

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

656 } /* end else AFC_INIT*/

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

657

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

658 *frame_count=0;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

659 //Locosto

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

660 // return(Psi_quant[C_N_del]>>3); /* F16.0 */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

661 return(CONVERT_PSI_QUANT(Psi_quant[C_N_del])); /* F16.0 to 14.2 or 13.3 */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

662

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

663 #else

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

664

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

665 } /* end case algo 1 */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

666

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

667

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

668 /* algo2 + init + estimator/predictor */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

669 case ALGO_AFC_LQG_PREDICTOR:

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

670 {

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

671 /******************************************************************/

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

672 /* (New) VCXO Algorithm */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

673 /******************************************************************/

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

674

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

675 switch (phase) {

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

676 case AFC_INIT_CENTER :

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

677 case AFC_INIT_MAX :

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

678 case AFC_INIT_MIN :

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

679 quant_avg = 0;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

680 M_Count = 0;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

681 for (i = 0; i <= C_PSI_AVG_SIZE_D ; i++) //omaps00090550

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

682 psi_avg[i] = 0;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

683 first_avg = 1;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

684 good_snr = 0;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

685

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

686 // DAC search algorithm is as follows - up to 12 attempts are made

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

687 // DAC search algorithm uses three values : DAC_center -> DAC_max -> DAC_min ->

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

688 // The first four attempts are made on DAC_center

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

689 // The next four attempts are made on DAC_max

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

690 // The last four attempts are made on DAC_min

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

691 // There are statistical reasons for trying four times

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

692

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

693 switch (phase)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

694 {

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

695 case AFC_INIT_CENTER:

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

696 psi_quant = l1_config.params.afc_dac_center;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

697 break;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

698 case AFC_INIT_MAX:

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

699 psi_quant = l1_config.params.afc_dac_max;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

700 break;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

701 case AFC_INIT_MIN:

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

702 psi_quant = l1_config.params.afc_dac_min;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

703 break;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

704 default :

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

705 break;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

706 }

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

707

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

708 /* F0.32 * F13.3 = F5.35 */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

709 psi_past[C_N_del]=Mult_40b(l1_config.params.psi_st_32,psi_quant, &guardout);

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

710 /* (F13.3<<16 )+(F5.35>>16) = F13.19 */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

711 psi_past[C_N_del]=((WORD32)guardout<<16)+((UWORD32)psi_past[C_N_del]>>16);

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

712

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

713 break;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

714

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

715 case AFC_OPEN_LOOP :

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

716 {

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

717 /* VCXO changes for spurious FB detection */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

718 if (l1s.spurious_fb_detected == TRUE)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

719 {

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

720 psi_quant = old_psi_quant;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

721

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

722 for(i=0;i<C_N_del+1;i++)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

723 psi_past[i] = old_psi_past[i];

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

724

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

725 /* reset the spurious_fb_detected_flag */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

726 l1s.spurious_fb_detected = FALSE;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

727 } /* end of spuriousFB detected */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

728

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

729 /* save in memory the old AFC related values */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

730 old_psi_quant = psi_quant;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

731

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

732 for(i=0;i<C_N_del+1;i++)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

733 old_psi_past[i] = psi_past[i];

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

734

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

735 /* delay line for psi_quant values */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

736 for (i = 1; i <= C_N_del; i++)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

737 psi_past[i-1] = psi_past[i];

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

738

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

739 /* (F16.0 * F1.15 = F17.15) << 4 = F13.19 */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

740 var_32 = (WORD32) ((WORD32)angle * l1_config.params.psi_sta_inv) << 4;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

741

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

742 #if(RF_FAM == 61)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

743 /* In order to implement the NINT function for a F16.0,*/

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

744 /*we check if var_32 + 0.5*2**18 is a multiple of 2**18 */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

745 var_16 = (WORD16)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

746 ((WORD32) (((WORD32)(var_32 + (1<<17))) / (1<<18)));

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

747 var_16 = var_16 * 4;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

748 #else

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

749 /* In order to implement the NINT function for a F16.0,*/

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

750 /*we check if var_32 + 0.5*2**19 is a multiple of 2**19 */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

751 var_16 = (WORD16)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

752 ((WORD32) (((WORD32)(var_32 + (1<<18))) / (1<<19)));

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

753 var_16 = var_16 * 8;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

754 #endif

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

755 if (var_16 > C_max_step)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

756 psi_quant = Add_Sat_sign_16b(psi_quant,C_max_step);

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

757 else if (var_16 < C_min_step)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

758 psi_quant = Add_Sat_sign_16b(psi_quant,C_min_step);

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

759 else psi_quant = Add_Sat_sign_16b(psi_quant,var_16); /* F13.3 */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

760 /* F0.32 * F13.3 = F5.35 */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

761 psi_past[C_N_del]=Mult_40b(l1_config.params.psi_st_32,psi_quant, &guardout);

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

762 /* (F13.3<<16 )+(F5.35>>16) = F13.19 */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

763 psi_past[C_N_del]=((WORD32)guardout<<16)+((UWORD32)psi_past[C_N_del]>>16);

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

764

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

765 }

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

766 break;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

767

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

768 case AFC_CLOSED_LOOP :

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

769

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

770 /* delay line for psi_quant values */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

771 for (i = 1; i <= C_N_del; i++)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

772 psi_past[i-1] = psi_past[i];

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

773

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

774 /************************************/

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

775 /* Estimation */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

776 /************************************/

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

777 if ( (l1_config.params.rgap_algo != 0) &&

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

778 ((l1_mode==CON_EST_MODE2)||(l1_mode==DEDIC_MODE)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

779 #if L1_GPRS

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

780 || l1_mode==PACKET_TRANSFER_MODE

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

781 #endif

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

782 ))

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

783 {

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

784

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

785 M_Count += *frame_count;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

786 if (snr >= l1_config.params.afc_snr_thr) {

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

787 // Accumulate average over N TDMA frames

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

788 psi_avg[0] += psi_past[C_N_del];

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

789 // Count number of good snr's within window_avg_size chunks

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

790 good_snr++;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

791 }

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

792 // M_Count >= M ?

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

793 if (M_Count >= l1_config.params.afc_win_avg_size_M) {

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

794 // M_Count counts how far we have reached in the window_avg_size blocks

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

795

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

796 // Scale estimate relative to good snr - Don't divide by zero in case of bad measurements

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

797 if (good_snr > 0)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

798 psi_avg[0] /= good_snr;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

799

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

800 // We now have an estimation over window_avg_size TDMA frames in psi_avg[0]

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

801 if (first_avg == 1) {

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

802 first_avg = 0;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

803 // Use first estimation as best guess for the other avg values

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

804 // This is used both at initialisation and when returning from reception gap

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

805 for (i = 1; i <= C_PSI_AVG_SIZE_D ; i++)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

806 psi_avg[i] = psi_avg[0];

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

807 }

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

808

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

809 // Estimation 1st order

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

810 // Use biggest window to reduce noise effects signal in psi values

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

811 // NOTE: Due to performance issues division by MSIZE is in predictor

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

812 if (l1_config.params.rgap_algo >= 1) {

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

813 quant_avg = (WORD16) (psi_avg[0] - psi_avg[C_PSI_AVG_SIZE_D]);

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

814 }

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

815

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

816 for (i = C_PSI_AVG_SIZE_D - 1; i >= 0 ; i--)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

817 psi_avg[i+1] = psi_avg[i];

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

818 psi_avg[0] = 0;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

819 M_Count = 0;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

820 good_snr = 0;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

821 }

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

822

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

823 } else {

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

824 // No estmation when in Idle mode (DEEP or BIG SLEEP) => Reset!

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

825 first_avg = 1;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

826 M_Count = 0;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

827 good_snr = 0;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

828 psi_avg[0] = 0;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

829 }

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

830

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

831 if (snr >= l1_config.params.afc_snr_thr) {

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

832 /********************/

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

833 /* Filter algorithm */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

834 /********************/

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

835

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

836 /* No prediction during normal operation */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

837 B_Count= 0;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

838

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

839 /* Clip error angle */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

840 if (angle > C_thr_phi)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

841 angle = C_thr_phi;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

842 if (angle < -C_thr_phi)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

843 angle = -C_thr_phi;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

844

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

845 Phi_32 = psi_past[C_N_del] - psi_past[0]; /* F13.19 */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

846 /* Phi = angle - Phi_32*/

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

847 Phi_32 = ((WORD32) angle << 4) - Phi_32;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

848 /* F1.15 * 4 = F13.19 */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

849 Phi = (WORD16)((WORD32)((WORD32)(Phi_32 + (1<<3)))/ (1<<4)); /* F17.15 */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

850 /* (F0.20 * F1.15) >> 16 = F13.19 */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

851 var_32 = (L * Phi + (1<<15)) >> 16;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

852 psi_past[C_N_del] = Add_Sat_sign_32b(psi_past[C_N_del],var_32);

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

853

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

854

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

855 }

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

856 else

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

857 {

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

858 /************************************/

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

859 /* Prediction */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

860 /************************************/

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

861

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

862 // Only predict in dedicated mode

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

863 // NO prediction in idle mode

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

864 // l1a_l1s_com.dedic_set.SignalCode = NULL

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

865 if ( (l1_config.params.rgap_algo != 0) &&

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

866 ((l1_mode==CON_EST_MODE2)||(l1_mode==DEDIC_MODE)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

867 #if L1_GPRS

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

868 || l1_mode==PACKET_TRANSFER_MODE

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

869 #endif

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

870 ))

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

871 {

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

872 /* Prediction of psi during reception gaps */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

873 B_Count

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

874 += *frame_count;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

875

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

876 /* Predict psi ONLY when we have sufficient measurements available */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

877 /* If we don't have enough measurements we don't do anything (= 0th order estimation)*/

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

878

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

879 // Was the consecutive bad SNRs threshold value exceeded?

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

880 if (B_Count>= l1_config.params.rgap_bad_snr_count_B) {

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

881

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

882 // Predict with 0th order estimation is the default

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

883

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

884 // Predict with 1st order estimation

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

885 if (l1_config.params.rgap_algo >= 1)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

886 {

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

887 psi_past[C_N_del] = Add_Sat_sign_32b(psi_past[C_N_del],

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

888 ((quant_avg * (l1_config.params.rgap_bad_snr_count_B))/(C_MSIZE))

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

889 );

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

890 }

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

891

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

892 B_Count= B_Count - l1_config.params.rgap_bad_snr_count_B;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

893

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

894 // Indicate by raising first_avg flag that a reception gap has occurred

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

895 // I.e. the psi_avg table must be reinitialised after leaving reception gap

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

896 first_avg = 1;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

897

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

898 // Counters in estimation part must also be reset

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

899 M_Count = 0;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

900 good_snr = 0;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

901 psi_avg[0] = 0;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

902 }

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

903 }

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

904 }

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

905

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

906 /* Quantize psi value */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

907

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

908 /* F0.19 * 16.0 = F16.19 */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

909 var_32 = Sat_Mult_20sign_16unsign(psi_past[C_N_del],l1_config.params.psi_st_inv);

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

910

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

911 #if(RF_FAM == 61)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

912 /* In order to implement the NINT function for a F13.3,*/

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

913 /*we check if var_32 + 0.5*2**18 is a multiple of 2**18 */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

914 var_16 = (WORD16)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

915 ((WORD32)((WORD32)(var_32 + (1<<17))) / (1<<18));

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

916 var_16 = var_16 * 4;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

917 #else

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

918 /* In order to implement the NINT function for a F13.3,*/

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

919 /*we check if var_32 + 0.5*2**19 is a multiple of 2**19 */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

920 var_16 = (WORD16)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

921 ((WORD32)((WORD32)(var_32 + (1<<18))) / (1<<19));

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

922 var_16 = var_16 * 8;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

923 #endif

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

924 if (var_16 > C_max_step)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

925 psi_quant = C_max_step;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

926 else if (var_16 < C_min_step)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

927 psi_quant = C_min_step;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

928 else

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

929 psi_quant = var_16; /* F13.3 */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

930 break;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

931 } // switch phase

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

932

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

933 *frame_count = 0;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

934

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

935 //Locosto

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

936 // return (psi_quant >> 3); /* F16.0 */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

937 return(CONVERT_PSI_QUANT(psi_quant)); /* F16.0 to 14.2 or 13.3 */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

938 } /* end case algo 2 */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

939

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

940 /* algo1 + init + estimator/predictor */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

941 case ALGO_AFC_KALMAN_PREDICTOR:

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

942 {

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

943 if ((phase==AFC_INIT_CENTER) || (phase==AFC_INIT_MAX) || (phase==AFC_INIT_MIN))

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

944 {

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

945 // WARNING

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

946 // In this case, "angle" variable contains EEPROM_AFC initialization value

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

947 // directly loaded from EEPROM, and "snr" variable is not meaningful.

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

948 /* Static variables initialisation */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

949

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

950 quant_avg = 0;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

951 M_Count = 0;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

952 for (i = 0; i <=C_PSI_AVG_SIZE_D ; i++) //omaps00090550

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

953 psi_avg[i] = 0;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

954 first_avg = 1;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

955 good_snr = 0;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

956

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

957 // DAC search algorithm is as follows - up to 12 attempts are made

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

958 // DAC search algorithm uses three values : DAC_center -> DAC_max -> DAC_min ->

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

959 // The first four attempts are made on DAC_center

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

960 // The next four attempts are made on DAC_max

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

961 // The last four attempts are made on DAC_min

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

962 // There are statistical reasons for trying four times

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

963

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

964 switch (phase) {

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

965 case AFC_INIT_CENTER:

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

966 Psi_quant[C_N_del] = l1_config.params.afc_dac_center;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

967 break;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

968 case AFC_INIT_MAX:

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

969 Psi_quant[C_N_del] = l1_config.params.afc_dac_max;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

970 break;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

971 case AFC_INIT_MIN:

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

972 Psi_quant[C_N_del] = l1_config.params.afc_dac_min;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

973 break;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

974 default :

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

975 break;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

976 }

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

977

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

978 P=C_cov_start;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

979 Psi=0;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

980 if (angle>C_max_step)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

981 Psi_quant[C_N_del]=C_max_step;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

982 else

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

983 if(angle<C_min_step)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

984 Psi_quant[C_N_del]=C_min_step;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

985 else Psi_quant[C_N_del]=angle;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

986

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

987 /* F0.32 * F13.3 = F5.35 */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

988 Psi=Mult_40b(l1_config.params.psi_st_32,Psi_quant[C_N_del], &guardout);

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

989 /* (F13.3<<16 )+(F5.35>>16) = F13.19 */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

990 Psi=((WORD32)guardout<<16)+((UWORD32)Psi>>16);

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

991

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

992 } /* end AFC_INIT*/

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

993 else

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

994 {

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

995 if (phase==AFC_OPEN_LOOP)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

996 {

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

997 /* relaod last good values in the ALGO */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

998 if (l1s.spurious_fb_detected == TRUE)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

999 {

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1000 for(i=0;i<C_N_del+1;i++)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1001 Psi_quant[i] = old_Psi_quant[i];

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1002

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1003 Psi = old_Psi;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1004 l1s.spurious_fb_detected = FALSE;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1005 }

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1006

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1007 /* Save the old values in memory */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1008 for(i=0;i<C_N_del+1;i++)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1009 old_Psi_quant[i] = Psi_quant[i];

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1010 old_Psi = Psi;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1011

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1012 /* delay line for Psi_quant values */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1013 for (i=1;i<=C_N_del;i++)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1014 Psi_quant[i-1]=Psi_quant[i];

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1015

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1016 var_32=(WORD32)((WORD32)angle*l1_config.params.psi_sta_inv)<<4;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1017 /*(F16.0 * F1.15 = F17.15) << 4 = F13.19 */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1018

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1019 #if(RF_FAM == 61)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1020 /* In order to implement the NINT function for a F16.0, we check */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1021 /* if var_32 + 0.5*2**18 is a multiple of 2**18 */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1022 quotient=(WORD16)((WORD32)(((WORD32)(var_32+(1<<17)))/(1<<18)));

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1023 var_16=quotient*4;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1024 #else

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1025 /* In order to implement the NINT function for a F16.0, we check */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1026 /* if var_32 + 0.5*2**19 is a multiple of 2**19 */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1027 quotient=(WORD16)((WORD32)(((WORD32)(var_32+(1<<18)))/(1<<19)));

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1028 var_16=quotient*8;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1029 #endif

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1030 if (var_16>C_max_step)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1031 Psi_quant[C_N_del]=Add_Sat_sign_16b(Psi_quant[C_N_del],C_max_step);

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1032 else

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1033 if(var_16<C_min_step)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1034 Psi_quant[C_N_del]=Add_Sat_sign_16b(Psi_quant[C_N_del],C_min_step);

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1035 else Psi_quant[C_N_del]=Add_Sat_sign_16b(Psi_quant[C_N_del],var_16); /* F13.3 */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1036

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1037

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1038

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1039 /* F0.32 * F13.3 = F5.35 */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1040 Psi=Mult_40b(l1_config.params.psi_st_32,Psi_quant[C_N_del], &guardout);

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1041 /* (F13.3<<16 )+(F5.35>>16) = F13.19 */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1042 Psi=((WORD32)guardout<<16)+((UWORD32)Psi>>16);

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1043

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1044 }/*end if AFC_OPEN_LOOP*/

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1045 else

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1046 {

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1047

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1048 /* delay line for Psi_quant values */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1049 for (i=1;i<=C_N_del;i++)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1050 Psi_quant[i-1]=Psi_quant[i];

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1051

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1052 /************************************/

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1053 /* Estimation */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1054 /************************************/

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1055 if ( (l1_config.params.rgap_algo != 0) &&

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1056 ((l1_mode==CON_EST_MODE2)||(l1_mode==DEDIC_MODE)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1057 #if L1_GPRS

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1058 || l1_mode==PACKET_TRANSFER_MODE

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1059 #endif

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1060 ))

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1061 {

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1062

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1063 M_Count += *frame_count;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1064 if (snr >= l1_config.params.afc_snr_thr) {

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1065 // Accumulate average over N TDMA frames

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1066 psi_avg[0] += psi_past[C_N_del];

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1067 // Count number of good snr's within window_avg_size chunks

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1068 good_snr++;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1069 }

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1070

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1071 // M_Count >= M ?

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1072 if (M_Count >= l1_config.params.afc_win_avg_size_M) {

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1073 // M_Count counts how far we have reached in the window_avg_size blocks

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1074

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1075 // Scale estimate relative to good snr - Don't divide by zero in case of bad measurements

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1076 if (good_snr > 0)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1077 psi_avg[0] /= good_snr;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1078

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1079 // We now have an estimation over window_avg_size TDMA frames in psi_avg[0]

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1080 if (first_avg == 1) {

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1081 first_avg = 0;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1082 // Use first estimation as best guess for the other avg values

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1083 // This is used both at initialisation and when returning from reception gap

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1084 for (i = 1; i <= C_PSI_AVG_SIZE_D ; i++)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1085 psi_avg[i] = psi_avg[0];

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1086 }

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1087

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1088 // Estimation 1st order

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1089 // Use biggest window to reduce noise effects signal in psi values

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1090 // NOTE: Due to performance issues division by MSIZE is in predictor

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1091 if (l1_config.params.rgap_algo >= 1) {

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1092 quant_avg = (WORD16) (psi_avg[0] - psi_avg[C_PSI_AVG_SIZE_D]);

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1093 }

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1094

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1095 for (i = C_PSI_AVG_SIZE_D - 1; i >= 0 ; i--)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1096 psi_avg[i+1] = psi_avg[i];

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1097 psi_avg[0] = 0;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1098 M_Count = 0;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1099 good_snr = 0;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1100 }

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1101

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1102 } else {

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1103 // No estmation when in Idle mode (DEEP or BIG SLEEP) => Reset!

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1104 first_avg = 1;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1105 M_Count = 0;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1106 good_snr = 0;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1107 psi_avg[0] = 0;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1108 }

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1109

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1110 /********************/

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1111 /* Filter algorithm */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1112 /********************/

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1113

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1114 /* Covariance error is increased of C_Q */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1115 P=P+(*frame_count)*C_Q;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1116

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1117 /* Clipping of P */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1118 if (P>C_thr_P) P=C_thr_P;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1119

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1120 if (snr>=C_thr_snr)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1121 {

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1122 /* Clipping of error angle */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1123 if (angle>C_thr_phi)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1124 angle=C_thr_phi;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1125 if (angle<-C_thr_phi)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1126 angle=-C_thr_phi;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1127

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1128 /* Kalman gain */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1129 /*K=P*(1/(P+C_a0_kalman+(C_g_kalman*RNS))) */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1130 /*C_a0_kalman=0.01 */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1131 /*C_g_kalman =0.05 */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1132 num=(C_g_kalman/snr)+P+C_a0_kalman;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1133 /* (F2.30 / F6.10) = F 12.20 */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1134

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1135 /* denom = P << 19 = F 1.39 */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1136 /* extension of denom=P to a 40 bits variable */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1137 /* denom (F12.20) << 16 = F 4.36 */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1138 guard1=(WORD16)((WORD32)P>>16);

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1139 /* denom = P<<16 = (F4.36) << 3 = F 1.39 */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1140 denomH=(UWORD16)P;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1141 /* Low part of denom is equal to 0, because P has been 16 */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1142 /* bits left shifted previously. */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1143 denomH_3msb=(denomH>>13)&0x0007;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1144 guard1=(guard1<<3)|denomH_3msb;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1145 denomH<<=3;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1146 denom=denomH<<16; //(UWORD32) removed typecast omaps00090550

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1147 /* num + guard1 are a 40 bits representation of P */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1148 /* In order to compute P(F1.39)/num, we sample P in guard1 */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1149 /* (scaled to a 32 bits number) and num (32 bits number) */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1150 /* K = ((guard1<<24)/num)<<8 + (denom/num) */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1151 var1=(WORD32)guard1<<24;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1152 var1=var1/num;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1153 var1=(WORD32)var1<<8;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1154 /* var2 is an unsigned variable, var1 contains signed guard*/

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1155 /* bits. */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1156 var2= ((WORD32)(denom)/(num)); //omaps00090550

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1157 K = (var1+var2)<<1; /* F1.39 / F12.20 = F13.19 */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1158 /* F13.19 << 1 = F12.20 */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1159

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1160 /* Clipping of the Kalman gain */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1161 if (K>=C_thr_K)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1162 K=C_thr_K;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1163

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1164 /*******************************************************/

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1165 /* P=(1-K)*P = 0.8 * 0.5 at maximum */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1166 /*******************************************************/

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1167 /* Perform a positive variable F12.20 multiplication by*/

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1168 /* positive variable F12.20 */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1169 var_16=(WORD16)(1048576L-K); /* acclow(1-K) = F12.20 */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1170 guard1=0; /* positive variable */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1171 var1=UMult_40b(P,var_16,&guard1);

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1172 var_16=(WORD16)((1048576L-K)>>16);

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1173 /* acchigh(1-K) = F12.20 */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1174 var2=P*var_16; /* var2 = 0x80000 * 0xc */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1175 /* at maximum, so result */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1176 /* is 32 bits WORD32 and */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1177 /* equal 0x600000 */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1178 /* extension of var2 to a 40 bits variable : var2<<16 */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1179 guard2=(WORD16)((WORD32)var2>>16);

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1180 guard1guard2=((WORD32)guard1<<16) |((WORD32) guard2&0x0000FFFFL);

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1181 var2=var2<<16;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1182 var_32=Add_40b(guard1guard2,var1,var2,&guardout);

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1183 /* var_32 (F8.40) >> 16 = F8.24 */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1184 LGuard=(WORD32)guardout<<16;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1185 var1=(UWORD32)var_32>>16;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1186 /* var_32 >> 4 = F12.20 */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1187 P=(var1+LGuard)>>4;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1188

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1189 Phi_32=Mult_40b(l1_config.params.psi_st_32,Psi_quant[0],&guardout);

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1190 /* F0.32 * F13.3 = F5.35 */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1191 LGuard=(WORD32)guardout<<16; /* var_32 (F5.35) >> 16 */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1192 /* F13.19 */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1193 var1=(UWORD32)Phi_32>>16;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1194 Phi_32=Psi-(LGuard+var1); /* F13.19 */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1195

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1196 /*Phi=angle-Phi_32*/

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1197 Phi_32=((WORD32)angle<<4)-Phi_32;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1198 /* F1.15 * 4 = F13.19 */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1199 Phi=(WORD16)(Phi_32>>4); /* F17.15 */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1200 /*var1=K*Phi F12.20 * F1.15 = 13.35 */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1201 guard1=0;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1202 var1=Mult_40b(K,Phi,&guard1);

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1203 /* var1 (F13.35) >> 16 */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1204 /* F13.19 */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1205 LGuard=(WORD32)guard1<<16;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1206 var1=(UWORD32)var1>>16;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1207 Psi+=var1+LGuard;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1208 } else {

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1209 /************************************/

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1210 /* Prediction */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1211 /************************************/

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1212

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1213 // Only predict in dedicated mode

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1214 // NO prediction in idle mode

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1215 // l1a_l1s_com.dedic_set.SignalCode = NULL

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1216 if ( (l1_config.params.rgap_algo != 0) &&

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1217 ((l1_mode==CON_EST_MODE2)||(l1_mode==DEDIC_MODE)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1218 #if L1_GPRS

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1219 || l1_mode==PACKET_TRANSFER_MODE

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1220 #endif

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1221 ))

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1222 {

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1223

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1224 /* Prediction of psi during reception gaps */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1225 B_Count+= *frame_count;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1226

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1227 /* Predict psi ONLY when we have sufficient measurements available */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1228 /* If we don't have enough measurements we don't do anything (= 0th order estimation)*/

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1229

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1230 // Was the consecutive bad SNRs threshold value exceeded?

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1231 if (B_Count>= l1_config.params.rgap_bad_snr_count_B) {

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1232

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1233 // Predict with 0th order estimation is the default

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1234

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1235 // Predict with 1st order estimation

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1236 if (l1_config.params.rgap_algo >= 1)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1237 Psi += ((quant_avg * (l1_config.params.rgap_bad_snr_count_B))/(C_MSIZE));

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1238

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1239 B_Count= B_Count - l1_config.params.rgap_bad_snr_count_B;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1240

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1241 // Indicate by raising first_avg flag that a reception gap has occurred

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1242 // I.e. the psi_avg table must be reinitialised after leaving reception gap

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1243 first_avg = 1;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1244

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1245 // Counters in estimation part must also be reset

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1246 M_Count = 0;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1247 good_snr = 0;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1248 psi_avg[0] = 0;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1249 }

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1250 }

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1251 }

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1252

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1253 /* Quantize psi value */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1254

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1255 var_32=Mult_40b(Psi,l1_config.params.psi_st_inv,&guardout);

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1256 /* F13.19 * C = F13.19 */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1257

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1258 #if(RF_FAM == 61)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1259 /* In order to implement the NINT function for a F13.3, we check */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1260 /* if var_32 + 0.5*2**18 is a multiple of 2**18 */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1261 quotient=(WORD16)((WORD32)(((WORD32)(var_32+(1<<17)))/(1<<18)));

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1262 var_16=quotient*4;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1263 #else

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1264 /* In order to implement the NINT function for a F13.3, we check */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1265 /* if var_32 + 0.5*2**19 is a multiple of 2**19 */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1266 quotient=(WORD16)((WORD32)(((WORD32)(var_32+(1<<18)))/(1<<19)));

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1267 var_16=quotient*8;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1268 #endif

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1269 if (var_16>C_max_step)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1270 Psi_quant[C_N_del]=C_max_step;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1271 else

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1272 if(var_16<C_min_step)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1273 Psi_quant[C_N_del]=C_min_step;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1274 else Psi_quant[C_N_del]=var_16; /* F13.3 */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1275

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1276

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1277 }/*end AFC_CLOSE_LOOP*/

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1278 } /* end else AFC_INIT*/

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1279

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1280 *frame_count = 0;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1281 //Locosto

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1282 // return(Psi_quant[C_N_del]>>3); /* F16.0 */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1283 return(((CONVERT_PSI_QUANT(Psi_quant[C_N_del]))&0x3FFF)); /* F16.0 to 14.2 or 13.3 */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1284 } /* end case algo 3 */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1285 #endif

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1286

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1287 #if (VCXO_ALGO == 1)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1288 default:

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1289 return 0;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1290 //omaps00090550 break;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1291 } // end of Switch

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1292 #endif

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1293

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1294 } /* end l1ctl_afc */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1295

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1296

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1297 /************************************/

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1298 /* Automatic timing control (TOA) */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1299 /************************************/

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1300

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1301 #if (TOA_ALGO == 2)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1302

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1303 #define TOA_DEBUG_ENABLE 0

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1304

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1305

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1306 #if (TOA_DEBUG_ENABLE == 1)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1307

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1308 #define TOA_MAKE_ZERO 0

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1309

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1310 #define TOA_LOG_BUFFER_LENGTH 4096

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1311

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1312 typedef struct

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1313 {

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1314 UWORD16 SNR_val;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1315 UWORD16 TOA_val;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1316 UWORD16 l1_mode;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1317 UWORD16 toa_frames_counter;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1318 UWORD16 fn_mod42432;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1319 }T_TOA_log_debug;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1320

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1321

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1322 T_TOA_log_debug toa_log_debug[TOA_LOG_BUFFER_LENGTH];

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1323 UWORD32 toa_log_index;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1324

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1325 UWORD32 toa_make_zero_f;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1326

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1327 #endif

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1328

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1329 /*-------------------------------------------------------*/

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1330 /* l1ctl_toa() */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1331 /*-------------------------------------------------------*/

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1332 /* Parameters : */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1333 /* Return : */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1334 /* Functionality : */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1335 /*-------------------------------------------------------*/

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1336

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1337 WORD16 l1ctl_toa (UWORD8 phase, UWORD32 l1_mode, UWORD16 SNR_val, UWORD16 TOA_val)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1338 {

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1339 WORD16 TOA_period_len = TOA_PERIOD_LEN [l1_mode];

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1340 WORD16 TOA_SHIFT=ISH_INVALID;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1341 UWORD16 cumul_abs;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1342 WORD16 cumul_sign;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1343 WORD32 prod_tmp, div_tmp,prod_sign;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1344 WORD32 toa_update_flag=0;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1345 WORD16 cumul;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1346 UWORD16 cumul_counter;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1347 #if (NEW_TOA_ALGO == 1)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1348 UWORD16 Trans_active;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1349 static WORD16 cumul_noTrans =0;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1350 static UWORD16 period_counter_noTrans =0;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1351

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1352 if ((l1_mode==CON_EST_MODE2)||(l1_mode==DEDIC_MODE)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1353 #if L1_GPRS

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1354 || l1_mode==PACKET_TRANSFER_MODE

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1355 #endif

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1356 )

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1357 Trans_active=TRUE;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1358 else Trans_active=FALSE;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1359 #endif

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1360 if (phase==TOA_INIT)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1361 {

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1362 #if (NEW_TOA_ALGO == 1)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1363 cumul_noTrans =0;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1364 period_counter_noTrans =0;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1365 #endif

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1366

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1367 l1s.toa_var.toa_frames_counter=0;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1368 l1s.toa_var.toa_accumul_counter=0;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1369 l1s.toa_var.toa_accumul_value=0;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1370 #if (TOA_DEBUG_ENABLE == 1)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1371 toa_log_index = 0;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1372 #if (TOA_MAKE_ZERO == 1)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1373 toa_make_zero_f = 1;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1374 #else

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1375 toa_make_zero_f = 0;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1376 #endif

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1377 #endif

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1378

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1379 return (TOA_SHIFT);

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1380 }

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1381

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1382 cumul = l1s.toa_var.toa_accumul_value;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1383 cumul_counter = l1s.toa_var.toa_accumul_counter;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1384

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1385 #if (TOA_DEBUG_ENABLE == 1)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1386 toa_log_debug[toa_log_index].SNR_val = SNR_val;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1387 toa_log_debug[toa_log_index].TOA_val = TOA_val;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1388 toa_log_debug[toa_log_index].l1_mode = l1_mode;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1389 toa_log_debug[toa_log_index].toa_frames_counter = l1s.toa_var.toa_frames_counter;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1390 toa_log_debug[toa_log_index].fn_mod42432 = l1s.actual_time.fn_mod42432;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1391

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1392 toa_log_index++;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1393 if(toa_log_index == TOA_LOG_BUFFER_LENGTH)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1394 {

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1395 toa_log_index = 0;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1396 }

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1397 #endif /* #if (TOA_DEBUG_ENABLE == 1) */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1398

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1399 #if (TRACE_TYPE == 5)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1400 trace_toa_sim_ctrl(SNR_val, TOA_val, l1_mode, l1s.toa_var.toa_frames_counter,

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1401 l1s.toa_var.toa_accumul_counter, l1s.toa_var.toa_accumul_value);

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1402 #endif

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1403

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1404 l1s.toa_var.toa_frames_counter++;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1405

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1406 {

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1407 /* Fix for TOA */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1408 #define DSP_CALC_NO_TABS_HO 0x3CA4

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1409

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1410 UWORD16 *toa_ho_fix;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1411 toa_ho_fix=(UWORD16 *)API_address_dsp2mcu(DSP_CALC_NO_TABS_HO);

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1412

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1413 if ((TOA_val >= 22) || (TOA_val <= 6)) {

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1414 *toa_ho_fix = 1;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1415 }

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1416

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1417 if (*toa_ho_fix == 1) {

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1418 if((TOA_val <= 18) && (TOA_val >= 10)) {

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1419 *toa_ho_fix = 0;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1420 }

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1421 } else {

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1422 *toa_ho_fix = 0;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1423 }

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1424 }

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1425

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1426

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1427 #if (NEW_TOA_ALGO == 1)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1428 if (Trans_active)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1429 {

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1430 #endif

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1431 if (SNR_val>= L1_TOA_SNR_THRESHOLD)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1432 {

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1433 cumul_counter++;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1434

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1435 prod_tmp = L1_TOA_LAMBDA * cumul;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1436 prod_tmp = prod_tmp + ((0x00004000)); // basically for rounding

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1437 div_tmp = ((prod_tmp >> 15) & (0x0000FFFF));

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1438 cumul = div_tmp;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1439

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1440 // implemented below is

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1441 // cumul = cumul + (L1_TOA_ONE_MINUS_LAMBDA * signum(TOA_Val - L1_TOA_EXPECTED_TOA))

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1442 if(TOA_val > L1_TOA_EXPECTED_TOA) {

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1443 cumul = cumul + L1_TOA_ONE_MINUS_LAMBDA;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1444 }

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1445 else if (TOA_val < L1_TOA_EXPECTED_TOA) {

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1446 cumul = cumul - L1_TOA_ONE_MINUS_LAMBDA;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1447 }

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1448 } // End if SNR_val

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1449

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1450 if(l1s.toa_var.toa_update_flag == TRUE)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1451 {

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1452 toa_update_flag = 1;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1453 }

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1454

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1455 if (toa_update_flag)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1456 {

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1457 cumul_sign = (cumul>0)? 1: -1;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1458 cumul_abs = cumul_sign*cumul;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1459 if(cumul_counter <= 5)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1460 {

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1461 TOA_SHIFT = (cumul_abs<=L1_TOA_THRESHOLD_15)? 0: cumul_sign;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1462 }

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1463 else if(cumul_counter == 6)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1464 {

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1465 TOA_SHIFT = (cumul_abs<=L1_TOA_THRESHOLD_20)? 0: cumul_sign;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1466 }

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1467 else if(cumul_counter == 7)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1468 {

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1469 TOA_SHIFT = (cumul_abs<=L1_TOA_THRESHOLD_25)? 0: cumul_sign;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1470 }

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1471 else if(cumul_counter >= 8)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1472 {

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1473 TOA_SHIFT = (cumul_abs<=L1_TOA_THRESHOLD_30)? 0: cumul_sign;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1474 }

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1475 #if (TRACE_TYPE==1) || (TRACE_TYPE==4)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1476 trace_info.toa_trace_var.toa_accumul_value = cumul;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1477 trace_info.toa_trace_var.toa_accumul_counter = cumul_counter;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1478 trace_info.toa_trace_var.toa_frames_counter = l1s.toa_var.toa_frames_counter;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1479 #endif

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1480

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1481 cumul = 0;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1482 cumul_counter = 0;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1483 l1s.toa_var.toa_frames_counter = 0;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1484 l1s.toa_var.toa_update_flag = FALSE;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1485

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1486 #if (TOA_DEBUG_ENABLE == 1)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1487 #if (TOA_MAKE_ZERO == 1)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1488 if (toa_make_zero_f == 1)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1489 {

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1490 TOA_SHIFT=0;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1491 }

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1492 #endif /*#if (TOA_DEBUG_ENABLE == 1)*/

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1493 #endif /*#if (TOA_MAKE_ZERO == 1)*/

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1494

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1495 } // end of if toa_update_flag

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1496 #if (NEW_TOA_ALGO == 1)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1497

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1498 }

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1499

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1500 else

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1501 {

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1502 period_counter_noTrans++;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1503

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1504 if (SNR_val>= L1_TOA_SNR_THRESHOLD)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1505 {

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1506 cumul_noTrans = cumul_noTrans + TOA_val - L1_TOA_EXPECTED_TOA;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1507

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1508 } // End if SNR_val

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1509

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1510 if (l1s.toa_var.toa_update_flag == TRUE)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1511 {

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1512 switch (period_counter_noTrans)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1513 {

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1514 case 2:

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1515 if (cumul_noTrans>=0)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1516 TOA_SHIFT = (cumul_noTrans+1) >>1 ;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1517 else

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1518 TOA_SHIFT = (cumul_noTrans) >>1 ;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1519 break;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1520 case 3: /* Not fully accurate rounding*/

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1521 if (cumul_noTrans>=0)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1522 TOA_SHIFT = (cumul_noTrans+2)/3 ;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1523 else

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1524 TOA_SHIFT = (cumul_noTrans-2)/3 ;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1525 break;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1526 case 4:

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1527 if (cumul_noTrans>=0)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1528 TOA_SHIFT = (cumul_noTrans+2) >>2 ;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1529 else

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1530 TOA_SHIFT = (cumul_noTrans+1) >>2 ;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1531 break;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1532 default:

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1533 TOA_SHIFT = cumul_noTrans;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1534 break;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1535 } /* end switch*/

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1536

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1537 if (TOA_SHIFT>8)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1538 TOA_SHIFT =8;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1539 if (TOA_SHIFT<-8)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1540 TOA_SHIFT =-8;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1541

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1542 #if (TRACE_TYPE==1) || (TRACE_TYPE==4)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1543 trace_info.toa_trace_var.toa_accumul_value = cumul_noTrans;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1544 trace_info.toa_trace_var.toa_accumul_counter = period_counter_noTrans;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1545 trace_info.toa_trace_var.toa_frames_counter = period_counter_noTrans;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1546 #endif

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1547

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1548 cumul_noTrans = 0;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1549 period_counter_noTrans = 0;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1550 l1s.toa_var.toa_update_flag = FALSE;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1551 #if (TOA_DEBUG_ENABLE == 1)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1552 #if (TOA_MAKE_ZERO == 1)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1553 if (toa_make_zero_f == 1)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1554 {

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1555 TOA_SHIFT=0;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1556 }

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1557 #endif /*#if (TOA_DEBUG_ENABLE == 1)*/

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1558 #endif /*#if (TOA_MAKE_ZERO == 1)*/

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1559

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1560 } // end if update_flag

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1561 }

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1562 #endif

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1563 // error a TOA is waiting to be updated in the TPU and will be erased

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1564 #if (TRACE_TYPE==1) || (TRACE_TYPE==4)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1565 if (l1s.toa_var.toa_shift != ISH_INVALID)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1566 {

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1567 l1_trace_toa_not_updated (); // should not occur!!

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1568 }

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1569 #endif

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1570

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1571 if (TOA_SHIFT != ISH_INVALID) // new TOA => set the mask frames

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1572 {

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1573 // Set mask counter to 2 (2 frames masked).

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1574 l1s.toa_var.toa_snr_mask = 2;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1575 }

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1576

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1577 l1s.toa_var.toa_accumul_value = cumul;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1578 l1s.toa_var.toa_accumul_counter = cumul_counter;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1579

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1580 return(TOA_SHIFT);

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1581

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1582 } // l1ctl_toa

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1583

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1584

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1585 #else

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1586 /*-------------------------------------------------------*/

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1587 /* l1ctl_toa_update() */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1588 /*-------------------------------------------------------*/

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1589 /* Parameters : */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1590 /* Return : */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1591 /* Functionality : */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1592 /*-------------------------------------------------------*/

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1593 WORD16 l1ctl_toa_update(UWORD32 *TOASP, UWORD32 l1_mode)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1594 {

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1595 static UWORD16 Old_TOA_estimated=12; //unit is Qbit

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1596 UWORD32 TOAMAX;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1597 WORD16 IZW,ISH,i;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1598 UWORD32 TOA_estimated=0; //unit is Qbit

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1599 UWORD16 Trans_active;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1600

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1601 if ((l1_mode==CON_EST_MODE2)||(l1_mode==DEDIC_MODE)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1602 #if L1_GPRS

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1603 || l1_mode==PACKET_TRANSFER_MODE

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1604 #endif

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1605 )

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1606 Trans_active=TRUE;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1607 else Trans_active=FALSE;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1608

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1609 /* TOA offset computation and clock adjustement */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1610 TOAMAX=0;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1611 for (i=1;i<TOA_HISTO_LEN;i++)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1612 {

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1613 if (TOASP[i]>TOAMAX)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1614 TOAMAX=TOASP[i];

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1615 }

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1616 TOAMAX >>= C_RED;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1617 i=1;IZW=0;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1618 while (i<TOA_HISTO_LEN && IZW==0)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1619 {

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1620 if (TOASP[i]>=TOAMAX)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1621 IZW=i;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1622 i++;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1623 }

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1624

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1625 /* Estimated TOA calculation */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1626 if (TOASP[IZW-1]<(2*TOAMAX/3))

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1627 {

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1628 TOA_estimated=IZW;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1629 TOA_estimated *= 4; // unit in QBit

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1630 }

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1631 else

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1632 {

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1633 UWORD32 TOA_divisor = 0;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1634 TOA_estimated=(TOASP[IZW]*IZW)+(TOASP[IZW-1]*(IZW-1)>>C_GEW);

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1635 TOA_estimated *= 8; //F13.3 in order to have qBit precision

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1636 TOA_divisor = TOASP[IZW]+(TOASP[IZW-1] >> C_GEW);

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1637 if (TOA_divisor!=0)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1638 {

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1639 TOA_estimated/= TOASP[IZW]+(TOASP[IZW-1] >> C_GEW);

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1640 TOA_estimated /= 2; // unit in QBit ("/8" then "*4" = "/2")

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1641 }

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1642 else

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1643 {

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1644 TOA_estimated = 0;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1645 }

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1646 }

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1647

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1648 if (Trans_active)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1649 TOA_estimated=(TOA_estimated+(Old_TOA_estimated+4)) / 2;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1650

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1651 /* Offset calculation*/

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1652 if (TOA_estimated>=17 || TOA_estimated<=15)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1653 ISH=TOA_estimated - 16;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1654 else

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1655 ISH=0;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1656

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1657 if (Trans_active)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1658 {

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1659 if (ISH>1) ISH=1;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1660 if (ISH<-1) ISH=-1;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1661 }

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1662 else

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1663 {

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1664 if (ISH>8) ISH=8;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1665 if (ISH<-8) ISH=-8;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1666 }

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1667

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1668 Old_TOA_estimated = TOA_estimated - ISH - 4;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1669

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1670

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1671 return (ISH);

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1672 }

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1673

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1674 /*-------------------------------------------------------*/

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1675 /* l1ctl_toa() */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1676 /*-------------------------------------------------------*/

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1677 /* Parameters : */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1678 /* Return : */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1679 /* Functionality : generate an histogram of TOA weighted */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1680 /* with SNR */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1681 /*-------------------------------------------------------*/

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1682 WORD16 l1ctl_toa(UWORD8 phase, UWORD32 l1_mode, UWORD16 SNR_val, UWORD16 TOA_val, BOOL *toa_update, UWORD16 *toa_period_count

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1683 #if (FF_L1_FAST_DECODING == 1)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1684 , UWORD8 skipped_values

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1685 #endif

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1686 )

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1687 {

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1688 // xSignalHeaderRec *msg;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1689 UWORD16 i;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1690 WORD16 TOA_period_len = TOA_PERIOD_LEN[l1_mode];

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1691 static UWORD32 histo[TOA_HISTO_LEN];

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1692 static WORD16 period_counter=0;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1693 UWORD32 SNR_ZW;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1694 WORD16 ISH=ISH_INVALID;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1695

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1696 UWORD8 histo_center;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1697

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1698 #if 0

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1699 if ((l1_mode==CON_EST_MODE2)||(l1_mode==DEDIC_MODE))

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1700 histo_center=4;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1701 else

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1702 histo_center=5;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1703 #else

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1704 histo_center=4;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1705 #endif

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1706

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1707

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1708 if (phase==TOA_INIT)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1709 {

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1710 period_counter=0;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1711

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1712 for (i=0;i<TOA_HISTO_LEN;i++)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1713 histo[i]=0;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1714 histo[histo_center]=128; //F6.10

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1715

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1716 return(ISH);

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1717 }

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1718 #if (FF_L1_FAST_DECODING == 1)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1719 /* Manage any missing bursts due to fast decoding */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1720 period_counter += skipped_values;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1721 #endif

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1722

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1723 period_counter++;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1724 /* Filter update */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1725 if (SNR_val>=C_SNRGR)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1726 {

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1727 if (SNR_val>C_SNR_THR)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1728 SNR_ZW=C_SNR_THR;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1729 else

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1730 SNR_ZW=SNR_val;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1731 histo[TOA_val+1]+=SNR_ZW; /* if TOA=0 histo[1]++ */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1732 /* if TOA=1 histo[2]++ */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1733 /* ... */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1734 /* if TOA=9 histo[10]++ */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1735 /* histo[0] is reserved for computation */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1736 }

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1737

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1738 #if L1_GPRS

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1739 if (l1_mode==PACKET_TRANSFER_MODE)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1740 {

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1741 if (*toa_update)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1742 {

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1743 // Get ISH.

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1744 ISH = l1ctl_toa_update(histo, l1_mode);

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1745

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1746 //reset TOA period length counter

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1747 period_counter=0;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1748

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1749 //reset histogram

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1750 for (i=0;i<TOA_HISTO_LEN;i++)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1751 histo[i]=0;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1752 histo[histo_center]=128; //F6.10

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1753

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1754 *toa_update = FALSE; // reset TOA update flag

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1755 *toa_period_count = 0; // reset TOA period counter

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1756 }

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1757 }

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1758 else

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1759 #endif

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1760 if (period_counter>=TOA_period_len)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1761 // It is time to compute a new ISH and to reset the histogram.

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1762 // Rem: ">=" is very important since a "l1 mode" change can give

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1763 // a "TOA_period_len" smaller than the previous one an

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1764 // therefore a "period_counter" may be already higher than

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1765 // the new "TOA_period_len".

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1766 {

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1767 // Get ISH.

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1768 ISH = l1ctl_toa_update(histo, l1_mode);

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1769

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1770 //reset TOA period length counter

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1771 period_counter=0;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1772

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1773 //reset histogram

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1774 for (i=0;i<TOA_HISTO_LEN;i++)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1775 histo[i]=0;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1776 histo[histo_center]=128; //F6.10

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1777 }

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1778

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1779 // error a TOA is waiting to be updated in the TPU and will be erased

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1780 #if (TRACE_TYPE==1) || (TRACE_TYPE==4)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1781 if (l1s.toa_shift != ISH_INVALID)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1782 {

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1783 l1_trace_toa_not_updated(); // should not occur !!

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1784 }

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1785 #endif

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1786

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1787 if (ISH != ISH_INVALID) // new TOA => set the mask frames

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1788 {

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1789 // Set mask counter to 2 (2 frames masked).

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1790 l1s.toa_snr_mask = 2;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1791 }

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1792

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1793 return(ISH);

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1794 }

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1795 #endif

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1796

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1797 /*-------------------------------------------------------*/

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1798 /* l1ctl_txpwr() */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1799 /*-------------------------------------------------------*/

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1800 /* Parameters : */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1801 /* Return : */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1802 /* Functionality : */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1803 /*-------------------------------------------------------*/

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1804 UWORD8 l1ctl_txpwr(UWORD8 target_txpwr, UWORD8 current_txpwr)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1805 {

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1806 if(target_txpwr > current_txpwr)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1807 {

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1808 current_txpwr ++; // Increase TX power by 2 dB.

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1809 }

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1810 else

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1811 if(target_txpwr < current_txpwr)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1812 {

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1813 current_txpwr --; // Decrease TX power by 2 dB.

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1814 }

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1815

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1816 return(current_txpwr);

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1817 }

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1818

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1819

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1820 /************************************/

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1821 /* Automatic Gain Control */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1822 /************************************/

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1823 /*-------------------------------------------------------*/

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1824 /* l1ctl_encode_delta1() */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1825 /*-------------------------------------------------------*/

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1826 /* Parameters : */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1827 /* Return : */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1828 /* Functionality : */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1829 /*-------------------------------------------------------*/

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1830 #if(L1_FF_MULTIBAND == 0)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1831 WORD8 l1ctl_encode_delta1(UWORD16 radio_freq)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1832 {

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1833 switch(l1_config.std.id)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1834 {

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1835 case GSM:

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1836 case GSM_E:

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1837 case DCS1800:

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1838 case PCS1900:

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1839 case GSM850:

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1840 return(l1_config.std.cal_freq1_band1);

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1841 case DUAL:

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1842 case DUALEXT:

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1843 case DUAL_US:

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1844 if(radio_freq >= l1_config.std.first_radio_freq_band2)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1845 return(l1_config.std.cal_freq1_band2);

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1846 else

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1847 return(l1_config.std.cal_freq1_band1);

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1848 }

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1849 return 0;//omaps00090550

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1850

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1851 }

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1852 #endif

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1853 /*-------------------------------------------------------*/

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1854 /* l1ctl_encode_lna() */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1855 /*-------------------------------------------------------*/

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1856 /* Parameters : */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1857 /* Return : */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1858 /* Functionality : */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1859 /*-------------------------------------------------------*/

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1860 #if (L1_FF_MULTIBAND == 0)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1861 void l1ctl_encode_lna( UWORD8 input_level,

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1862 UWORD8 *lna_state,

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1863 UWORD16 radio_freq)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1864 {

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1865

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1866 /*** LNA Hysteresis is implemented as following :

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1867

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1868 |

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1869 On|---<>----+-------+

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1870 | | |

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1871 LNA | | |

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1872 | ^ v

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1873 | | |

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1874 | | |

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1875 Off| +-------+----<>-----

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1876 +--------------------------------

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1877 50 40 30 20 input_level /-dBm

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1878 THR_HIGH THR_LOW ***/

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1879

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1880

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1881

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1882

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1883

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1884 if(((l1_config.std.id == DUAL) || (l1_config.std.id == DUALEXT) ||(l1_config.std.id == DUAL_US)) &&

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1885 (radio_freq >= l1_config.std.first_radio_freq_band2))

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1886 {

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1887 if ( input_level > l1_config.std.lna_switch_thr_high_band2 ) // < -40dBm ?

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1888 {

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1889 *lna_state = LNA_ON; // lna_off = FALSE

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1890 }

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1891 else if ( input_level < l1_config.std.lna_switch_thr_low_band2 ) // > -30dBm ?

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1892 {

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1893 *lna_state = LNA_OFF; // lna off = TRUE

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1894 }

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1895 }

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1896 else

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1897 {

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1898 if ( input_level > l1_config.std.lna_switch_thr_high_band1 ) // < -40dBm ?

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1899 {

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1900 *lna_state = LNA_ON; // lna_off = FALSE

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1901 }

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1902 else if ( input_level < l1_config.std.lna_switch_thr_low_band1 ) // > -30dBm ?

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1903 {

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1904 *lna_state = LNA_OFF; // lna off = TRUE

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1905 }

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1906 }

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1907

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1908 }

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1909

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1910 #endif

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1911

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1912 /*-------------------------------------------------------*/

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1913 /* l1ctl_csgc() */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1914 /*-------------------------------------------------------*/

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1915 /* Description: */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1916 /* ============ */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1917 /* If we are running the first pass of a measurement */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1918 /* session, we use the HIGH_AGC default agc setting to */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1919 /* compute the input level from the measured power from */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1920 /* the DSP. If this input level is saturated we set a */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1921 /* saturation flag, otherwise we validate the measure and*/

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1922 /* store, for the considered carrier, the input level. */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1923 /* When all the carriers have been scanned and some have */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1924 /* been flagged "saturated", we measure them with the */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1925 /* LOW_AGC agc setting, then store, for the considered */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1926 /* carrier, the input level. */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1927 /*-------------------------------------------------------*/

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1928 UWORD8 l1ctl_csgc(UWORD8 pm, UWORD16 radio_freq)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1929 {

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1930 WORD16 current_IL, current_calibrated_IL =0; //omaps00090550

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1931 WORD8 delta1_freq, delta2_freq;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1932 WORD16 delta_drp_gain=0;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1933 UWORD32 index;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1934 UWORD16 g_magic;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1935 UWORD16 arfcn;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1936 UWORD16 dco_algo_ctl_pw_temp = 0;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1937 UWORD8 if_ctl = 0;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1938 #if (RF_RAM == 61) && (CODE_VERSION != SIMULATION)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1939 UWORD8 if_threshold = C_IF_ZERO_LOW_THRESHOLD_GSM;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1940 #endif

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1941

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1942 #if (L1_FF_MULTIBAND == 0)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1943

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1944 // initialize index

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1945 index = radio_freq - l1_config.std.radio_freq_index_offset;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1946

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1947 #else

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1948

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1949 index =

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1950 l1_multiband_radio_freq_convert_into_operative_radio_freq(radio_freq);

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1951

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1952 #endif /*if(L1_FF_MULTIBAND == 0)*/

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1953

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1954 delta1_freq = l1ctl_encode_delta1(radio_freq);

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1955 delta2_freq = l1ctl_encode_delta2(radio_freq);

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1956

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1957 g_magic = l1ctl_get_g_magic(radio_freq);

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1958 #if (L1_FF_MULTIBAND == 0)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1959 arfcn = Convert_l1_radio_freq(radio_freq);

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1960 #endif

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1961

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1962 if (l1a_l1s_com.full_list.meas_1st_pass_read)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1963 {

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1964 // We validate or not power measure (pm) for the considered carrier

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1965 // with measurement achieved with HIGH_AGC setting. We are working

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1966 // with non calibrated IL to avoid saturation

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1967 #if(RF_FAM == 61)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1968 #if (CODE_VERSION != SIMULATION)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1969

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1970 #if (PWMEAS_IF_MODE_FORCE == 0)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1971 cust_get_if_dco_ctl_algo(&dco_algo_ctl_pw_temp, &if_ctl, (UWORD8) L1_IL_INVALID ,

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1972 0,

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1973 radio_freq,if_threshold);

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1974 #else

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1975 if_ctl = IF_120KHZ_DSP;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1976 dco_algo_ctl_pw_temp = DCO_IF_0KHZ;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1977 #endif

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1978

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1979 #if (L1_FF_MULTIBAND == 0)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1980 delta_drp_gain = drp_gain_correction(arfcn, LNA_ON, (l1_config.params.high_agc << 1)); // F7.1 format

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1981 #else

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1982 delta_drp_gain = drp_gain_correction(radio_freq, LNA_ON, (l1_config.params.high_agc << 1)); // F7.1 format

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1983 #endif // MULTIBAND == 0 else

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1984

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1985 if(if_ctl == IF_100KHZ_DSP){

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1986 delta_drp_gain += SCF_ATTENUATION_LIF_100KHZ;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1987 }

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1988 else{ /* i.e. if_ctl = IF_120KHZ_DSP*/

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1989 delta_drp_gain += SCF_ATTENUATION_LIF_120KHZ;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1990 }

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1991

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1992 #endif

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1993 #endif

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1994 if (0==pm) // Check and filter illegal pm value by using last valid IL

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1995 current_IL = (WORD16)(l1a_l1s_com.last_input_level[index].input_level);

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1996 else

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1997 {

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1998 #if TESTMODE

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1999 if (!l1_config.agc_enable)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2000 current_IL = (WORD16)(-(pm - ( (l1_config.tmode.rx_params.agc << 1) - delta_drp_gain ) - g_magic));

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2001 else

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2002 #endif

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2003 current_IL = (WORD16)(-(pm - ( (l1_config.params.high_agc <<1) - delta_drp_gain) - g_magic));

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2004 // for array index purpose, we work with positive IL

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2005

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2006 }

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2007

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2008 // NOTE: lna_value do not appear in this formula because lna is ALWAYS ON for

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2009 // ---- this algorithm, so lna_value=lna_off*l1_config.params.lna_att_gsm=0

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2010

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2011 if ((current_IL<l1_config.params.high_agc_sat_thr) // Warning : we are working with positive IL

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2012 // for IL_2_AGC_xx index purpose.

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2013 #if TESTMODE

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2014 && (l1_config.agc_enable)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2015 #endif

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2016 )

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2017 {

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2018 // pm is saturated so measure is not valid

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2019 l1a_l1s_com.full_list.nbr_sat_carrier_ctrl++;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2020 l1a_l1s_com.full_list.nbr_sat_carrier_read++;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2021 l1a_l1s_com.full_list.sat_flag[l1a_l1s_com.full_list.next_to_read] = 1;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2022 }

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2023 else

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2024 {

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2025 current_calibrated_IL = current_IL - delta1_freq - delta2_freq;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2026

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2027 #if TESTMODE

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2028 // When running with fixed AGC setting saturated carriers may occur:

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2029 // protect against negative IL;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2030 if ((!l1_config.agc_enable) && (current_calibrated_IL < 0))

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2031 {

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2032 current_calibrated_IL=0;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2033 current_IL=0;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2034 }

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2035 #endif

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2036

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2037 // Protect IL stores against overflow

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2038 if (current_calibrated_IL>INDEX_MAX)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2039 current_calibrated_IL=INDEX_MAX;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2040 if (current_IL>INDEX_MAX)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2041 current_IL=INDEX_MAX;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2042

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2043 // we validate the measure and save input_level and lna_off fields.

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2044 l1ctl_encode_lna((UWORD8)(current_calibrated_IL>>1),

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2045 &(l1a_l1s_com.last_input_level[index].lna_off),

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2046 radio_freq);

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2047

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2048 l1a_l1s_com.last_input_level[index].input_level = (UWORD8)current_IL;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2049 l1a_l1s_com.full_list.sat_flag[l1a_l1s_com.full_list.next_to_read] = 0;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2050 }

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2051 }

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2052 else // 2nd pass if any.

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2053 {

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2054 // we validate the measure and save input_level and lna_off(always 0)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2055 // fields.

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2056 #if(RF_FAM == 61)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2057 #if (CODE_VERSION != SIMULATION)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2058 cust_get_if_dco_ctl_algo(&dco_algo_ctl_pw_temp, &if_ctl, (UWORD8) L1_IL_INVALID,

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2059 0,radio_freq,if_threshold);

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2060 #if (L1_FF_MULTIBAND == 0)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2061 delta_drp_gain = drp_gain_correction(arfcn, LNA_ON, (l1_config.params.low_agc << 1)); // F7.1 format

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2062 #else

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2063 delta_drp_gain = drp_gain_correction(radio_freq, LNA_ON, (l1_config.params.low_agc << 1)); // F7.1 format

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2064 #endif

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2065 if(if_ctl == IF_100KHZ_DSP){

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2066 delta_drp_gain += SCF_ATTENUATION_LIF_100KHZ;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2067 }

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2068 else{ /* i.e. if_ctl = IF_120KHZ_DSP*/

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2069 delta_drp_gain += SCF_ATTENUATION_LIF_120KHZ;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2070 }

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2071 #endif

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2072 #endif

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2073

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2074

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2075 if (0==pm) // Check and filter illegal pm value by using last valid IL

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2076 current_IL = (WORD16)(l1a_l1s_com.last_input_level[index].input_level);

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2077 else

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2078 current_IL = (WORD16)(-(pm - ( (l1_config.params.low_agc << 1) - delta_drp_gain ) - g_magic));

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2079

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2080 current_calibrated_IL = current_IL - delta1_freq - delta2_freq;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2081

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2082 // Protect IL stores against overflow

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2083 if (current_calibrated_IL>INDEX_MAX)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2084 current_calibrated_IL=INDEX_MAX;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2085 if (current_IL>INDEX_MAX)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2086 current_IL=INDEX_MAX;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2087

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2088 l1ctl_encode_lna((UWORD8)(current_calibrated_IL>>1),

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2089 &(l1a_l1s_com.last_input_level[index].lna_off),

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2090 radio_freq);

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2091

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2092 l1a_l1s_com.last_input_level[index].input_level = (UWORD8)current_IL;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2093

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2094 l1a_l1s_com.full_list.sat_flag[l1a_l1s_com.full_list.next_to_read] = 0;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2095 }

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2096

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2097 return((UWORD8)current_calibrated_IL);

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2098 }

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2099

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2100 /*-------------------------------------------------------*/

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2101 /* l1ctl_pgc() */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2102 /*-------------------------------------------------------*/

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2103 /* Description : For a given radio_freq, last_known_agc is */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2104 /* ============ based on a prior knowledge (the last */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2105 /* stored input_level for the considered */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2106 /* carrier). From the power measurement on */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2107 /* this carrier (pm), we update the */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2108 /* input_level for this carrier, for the */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2109 /* next task to control. */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2110 /*-------------------------------------------------------*/

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2111 UWORD8 l1ctl_pgc(UWORD8 pm, UWORD8 last_known_il,

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2112 UWORD8 lna_off, UWORD16 radio_freq)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2113 {

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2114 WORD32 last_known_agc;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2115 WORD32 current_IL, current_calibrated_IL;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2116 WORD8 delta1_freq, delta2_freq;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2117 WORD16 delta_drp_gain=0;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2118 WORD32 index, lna_value;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2119 UWORD16 arfcn;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2120 UWORD16 dco_algo_ctl_pw_temp = 0;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2121 UWORD8 if_ctl = 0;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2122 #if (RF_RAM == 61) && (CODE_VERSION != SIMULATION)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2123 UWORD8 if_threshold = C_IF_ZERO_LOW_THRESHOLD_GSM;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2124 #endif

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2125

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2126 #if (L1_FF_MULTIBAND == 0)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2127

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2128 // initialize index

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2129 index = radio_freq - l1_config.std.radio_freq_index_offset;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2130

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2131 #else

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2132

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2133 index = l1_multiband_radio_freq_convert_into_operative_radio_freq(radio_freq);

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2134

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2135 #endif // #if (L1_FF_MULTIBAND == 0) else

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2136

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2137 delta1_freq = l1ctl_encode_delta1(radio_freq);

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2138 delta2_freq = l1ctl_encode_delta2(radio_freq);

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2139

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2140 lna_value = lna_off * l1ctl_get_lna_att(radio_freq);

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2141

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2142 last_known_agc = (Cust_get_agc_from_IL(radio_freq, last_known_il >> 1, PWR_ID, lna_off)) << 1;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2143 // F7.1 in order to be compatible with

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2144 // pm and IL formats [-20,+140 in F7.1]

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2145 // contain the input_level value we use

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2146 // in the associated CTL task to build

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2147 // the agc used in this CTL.

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2148 #if (L1_FF_MULTIBAND == 0)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2149 arfcn = Convert_l1_radio_freq(radio_freq);

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2150 #else

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2151 arfcn=radio_freq;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2152 #endif

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2153

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2154 #if(RF_FAM == 61)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2155 #if (CODE_VERSION != SIMULATION)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2156

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2157 #if (PWMEAS_IF_MODE_FORCE == 0)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2158 cust_get_if_dco_ctl_algo(&dco_algo_ctl_pw_temp, &if_ctl, (UWORD8) L1_IL_VALID ,

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2159 last_known_il,

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2160 radio_freq,if_threshold);

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2161 #else

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2162 if_ctl = IF_120KHZ_DSP;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2163 dco_algo_ctl_pw_temp = DCO_IF_0KHZ;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2164 #endif

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2165

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2166 delta_drp_gain = drp_gain_correction(arfcn, lna_off, last_known_agc); // F7.1 format

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2167 if(if_ctl == IF_100KHZ_DSP){

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2168 delta_drp_gain += SCF_ATTENUATION_LIF_100KHZ;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2169 }

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2170 else{ /* i.e. if_ctl = IF_120KHZ_DSP*/

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2171 delta_drp_gain += SCF_ATTENUATION_LIF_120KHZ;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2172 }

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2173

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2174 #endif

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2175 #endif

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2176

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2177 if (0==pm) // Check and filter illegal pm value by using last valid IL

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2178 current_IL = l1a_l1s_com.last_input_level[index].input_level ;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2179 else

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2180 current_IL = -(pm - (last_known_agc - delta_drp_gain) + lna_value - l1ctl_get_g_magic(radio_freq));

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2181

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2182 current_calibrated_IL = current_IL - delta1_freq - delta2_freq;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2183

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2184 // Protect IL stores against overflow

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2185 if (current_calibrated_IL>INDEX_MAX)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2186 current_calibrated_IL=INDEX_MAX;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2187 if (current_IL>INDEX_MAX)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2188 current_IL=INDEX_MAX;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2189

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2190 // we validate the measure and save input_level and lna_off fields

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2191 l1ctl_encode_lna((UWORD8)(current_calibrated_IL>>1),

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2192 &(l1a_l1s_com.last_input_level[index].lna_off),

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2193 radio_freq);

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2194

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2195 l1a_l1s_com.last_input_level[index].input_level = (UWORD8)current_IL;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2196

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2197 return((UWORD8)current_calibrated_IL);

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2198 }

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2199

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2200

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2201 /*-------------------------------------------------------*/

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2202 /* l1ctl_pgc2() */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2203 /*-------------------------------------------------------*/

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2204 /* Description : */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2205 /* ============= */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2206 /* from power measurement pm_high_agc, */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2207 /* achieve with an HIGH_AGC setting, and pm_low_agc */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2208 /* achieve with a LOW_AGC seeting, we deduce the new */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2209 /* AGC to apply in the next CTL task. */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2210 /*-------------------------------------------------------*/

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2211 void l1ctl_pgc2(UWORD8 pm_high_agc, UWORD8 pm_low_agc, UWORD16 radio_freq)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2212 {

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2213 UWORD8 pm;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2214 WORD32 IL_high_agc, IL_low_agc, new_IL, current_calibrated_IL;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2215 WORD8 delta1_freq, delta2_freq;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2216 WORD16 delta_high_drp_gain=0;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2217 WORD16 delta_low_drp_gain=0;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2218 WORD32 index;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2219 UWORD16 g_magic;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2220 UWORD16 arfcn;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2221 UWORD16 dco_algo_ctl_pw_temp = 0;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2222 UWORD8 if_ctl = 0;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2223 #if (RF_RAM == 61) && (CODE_VERSION != SIMULATION)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2224 UWORD8 if_threshold = C_IF_ZERO_LOW_THRESHOLD_GSM;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2225 #endif

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2226

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2227 #if (L1_FF_MULTIBAND == 0)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2228

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2229 // initialize index

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2230 index = radio_freq - l1_config.std.radio_freq_index_offset;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2231

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2232 #else

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2233

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2234 index =

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2235 l1_multiband_radio_freq_convert_into_operative_radio_freq(radio_freq);

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2236

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2237 #endif // #if (L1_FF_MULTIBAND == 0) else

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2238

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2239 delta1_freq = l1ctl_encode_delta1(radio_freq);

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2240 delta2_freq = l1ctl_encode_delta2(radio_freq);

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2241

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2242 g_magic = l1ctl_get_g_magic(radio_freq);

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2243

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2244 // lna_off was set to 0 during CTRL, so lna_value = 0 do not appear in the following

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2245 // formula.

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2246

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2247 #if (L1_FF_MULTIBAND == 0)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2248 arfcn = Convert_l1_radio_freq(radio_freq);

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2249 #else

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2250 arfcn=radio_freq;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2251 #endif

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2252

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2253 if ((0==pm_high_agc) || (0==pm_low_agc)) // Check and filter illegal pm value(s) by using last valid IL

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2254 new_IL = l1a_l1s_com.last_input_level[index].input_level;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2255 else

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2256 {

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2257

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2258 #if(RF_FAM == 61)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2259 #if (CODE_VERSION != SIMULATION)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2260

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2261 #if (PWMEAS_IF_MODE_FORCE == 0)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2262 cust_get_if_dco_ctl_algo(&dco_algo_ctl_pw_temp, &if_ctl, (UWORD8) L1_IL_INVALID ,

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2263 0,

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2264 radio_freq,if_threshold);

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2265 #else

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2266 if_ctl = IF_120KHZ_DSP;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2267 dco_algo_ctl_pw_temp = DCO_IF_0KHZ;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2268 #endif

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2269

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2270

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2271 delta_high_drp_gain = drp_gain_correction(arfcn, LNA_ON, (l1_config.params.high_agc << 1)); // F7.1 format

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2272 delta_low_drp_gain = drp_gain_correction(arfcn, LNA_ON, (l1_config.params.low_agc << 1)); // F7.1 format

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2273 if(if_ctl == IF_100KHZ_DSP){

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2274 delta_high_drp_gain += SCF_ATTENUATION_LIF_100KHZ;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2275 delta_low_drp_gain += SCF_ATTENUATION_LIF_100KHZ;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2276 }

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2277 else{ /* i.e. if_ctl = IF_120KHZ_DSP*/

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2278 delta_high_drp_gain += SCF_ATTENUATION_LIF_120KHZ;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2279 delta_low_drp_gain += SCF_ATTENUATION_LIF_120KHZ;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2280 }

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2281 #endif

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2282 #endif

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2283

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2284 IL_high_agc = -(pm_high_agc - ((l1_config.params.high_agc << 1) - delta_high_drp_gain) - g_magic);

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2285 IL_low_agc = -(pm_low_agc - ((l1_config.params.low_agc << 1) - delta_low_drp_gain) - g_magic);

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2286

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2287 // HIGH_AGC and LOW_AGC are formatted to F7.1 in order to be compatible with

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2288 // pm and IL formats

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2289

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2290 if (IL_low_agc>=l1_config.params.low_agc_noise_thr)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2291 // pm_low_agc was on the noise floor, so not valid

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2292 {

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2293 // whatever the value of pm_high_agc, we consider it

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2294 // as the right setting

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2295 new_IL = IL_high_agc;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2296 pm = pm_high_agc;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2297 }

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2298 else

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2299 {

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2300 // pm_low_agc is valid.

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2301 if (IL_high_agc<=l1_config.params.high_agc_sat_thr)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2302 {

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2303 // pm_high_agc is not valid, it's saturated.

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2304 new_IL = IL_low_agc;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2305 pm = pm_low_agc;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2306 }

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2307 else

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2308 {

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2309 // both pm_low_agc and pm_high_agc are valid, so we test the one that

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2310 // gives the maximum input level and consider it as the right setting.

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2311 if (IL_high_agc<=IL_low_agc)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2312 {

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2313 new_IL = IL_high_agc;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2314 pm = pm_high_agc;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2315 }

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2316 else

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2317 {

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2318 new_IL = IL_low_agc;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2319 pm = pm_low_agc;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2320 }

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2321 }

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2322 }

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2323 }

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2324

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2325 #if (TRACE_TYPE == 1) || (TRACE_TYPE == 4)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2326 RTTL1_FILL_MON_MEAS(pm_high_agc, IL_high_agc - delta1_freq - delta2_freq, MS_AGC_ID, radio_freq)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2327 RTTL1_FILL_MON_MEAS(pm_low_agc, IL_low_agc - delta1_freq - delta2_freq, MS_AGC_ID, radio_freq)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2328 #endif

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2329

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2330 current_calibrated_IL = new_IL - delta1_freq - delta2_freq;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2331

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2332 // Protect IL stores against overflow

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2333 if (current_calibrated_IL>INDEX_MAX)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2334 current_calibrated_IL=INDEX_MAX;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2335 if (new_IL>INDEX_MAX)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2336 new_IL=INDEX_MAX;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2337

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2338 // Updating of input_level and lna_off fields in order to correctly

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2339 // setting the AGC for the next task.

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2340 l1ctl_encode_lna((UWORD8)(current_calibrated_IL>>1),

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2341 &(l1a_l1s_com.last_input_level[index].lna_off),

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2342 radio_freq);

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2343

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2344 l1a_l1s_com.last_input_level[index].input_level = (UWORD8)new_IL;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2345 }

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2346

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2347

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2348 /*-------------------------------------------------------*/

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2349 /* l1ctl_find_max() */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2350 /*-------------------------------------------------------*/

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2351 /* Parameters : */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2352 /* Return : */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2353 /* Functionality : */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2354 /*-------------------------------------------------------*/

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2355 UWORD8 l1ctl_find_max(UWORD8 *buff, UWORD8 buffer_len)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2356 {

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2357

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2358 // WARNING: for array index purpose we work with POSITIVE input level

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2359 // so maximum search for negative numbers is equivalent to

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2360 // minimum search for positive numbers!!!!!!

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2361 // (-30 > -120 but 30 < 120)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2362

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2363 UWORD8 maximum = 240;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2364 UWORD8 i;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2365

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2366 for (i=0; i<buffer_len; i++)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2367 {

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2368 if (buff[i]<maximum)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2369 maximum=buff[i];

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2370 }

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2371

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2372 return(maximum);

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2373 }

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2374

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2375 /*-------------------------------------------------------*/

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2376 /* l1ctl_pagc() */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2377 /*-------------------------------------------------------*/

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2378 /* Description : */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2379 /* =========== */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2380 /* We deduce the last_known_agc from the last stored */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2381 /* input_level for the considered carrier. We use this */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2382 /* agc value to "build" the input level linked to the pm */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2383 /* we have just read. */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2384 /* This input level is used to feed a fifo of 4 elements */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2385 /* and then compute an input_level maximum. This value is*/

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2386 /* used to update the input_level for this carrier. This */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2387 /* input_level will be used for the next task to control.*/

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2388 /*-------------------------------------------------------*/

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2389 UWORD8 l1ctl_pagc(UWORD8 pm, UWORD16 radio_freq, T_INPUT_LEVEL *IL_info_ptr)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2390 {

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2391 WORD8 delta1_freq, delta2_freq;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2392 WORD16 delta_drp_gain=0;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2393 WORD32 last_known_agc;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2394 UWORD8 IL_max;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2395 WORD32 current_IL, current_calibrated_IL;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2396 UWORD8 i;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2397 WORD32 lna_value;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2398 UWORD16 arfcn;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2399 UWORD8 lna_off;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2400 UWORD16 dco_algo_ctl_pw_temp = 0;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2401 UWORD8 if_ctl = 0;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2402 #if (RF_RAM == 61) && (CODE_VERSION != SIMULATION)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2403 UWORD8 if_threshold = C_IF_ZERO_LOW_THRESHOLD_GSM;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2404 #endif

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2405

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2406 delta1_freq = l1ctl_encode_delta1(radio_freq);

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2407 delta2_freq = l1ctl_encode_delta2(radio_freq);

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2408

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2409 // Update fifo

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2410 for (i=3;i>0;i--)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2411 l1a_l1s_com.Scell_info.buff_beacon[i]=l1a_l1s_com.Scell_info.buff_beacon[i-1];

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2412

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2413 // from the lna state (ON/OFF) we compute the attenuation

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2414 // that was applied to signal when performing the power

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2415 // measure.

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2416 lna_value = l1a_l1s_com.Scell_used_IL_dd.lna_off * l1ctl_get_lna_att(radio_freq);

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2417

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2418 // Compute applied agc for this pm

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2419 last_known_agc = (Cust_get_agc_from_IL(radio_freq, l1a_l1s_com.Scell_used_IL_dd.input_level >> 1, MAX_ID,l1a_l1s_com.Scell_used_IL_dd.lna_off )) << 1;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2420 // F7.1 in order to be compatible

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2421 // with pm and IL formats

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2422 // contain the input_level value we use

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2423 // in the associated CTL task to build

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2424 // the agc used in this CTL.

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2425

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2426 #if (L1_FF_MULTIBAND == 0)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2427 arfcn = Convert_l1_radio_freq(radio_freq);

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2428 #else

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2429 arfcn=radio_freq;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2430 #endif

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2431

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2432 #if(RF_FAM == 61)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2433 #if (CODE_VERSION != SIMULATION)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2434

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2435 cust_get_if_dco_ctl_algo(&dco_algo_ctl_pw_temp, &if_ctl, (UWORD8) L1_IL_VALID ,

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2436 l1a_l1s_com.Scell_used_IL_dd.input_level,

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2437 radio_freq,if_threshold);

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2438 lna_off = l1a_l1s_com.Scell_used_IL_dd.lna_off;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2439 delta_drp_gain = drp_gain_correction(arfcn, lna_off, last_known_agc); // F7.1 format

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2440 if(if_ctl == IF_100KHZ_DSP){

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2441 delta_drp_gain += SCF_ATTENUATION_LIF_100KHZ;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2442 }

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2443 else{ /* i.e. if_ctl = IF_120KHZ_DSP*/

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2444 delta_drp_gain += SCF_ATTENUATION_LIF_120KHZ;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2445 }

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2446

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2447 #endif

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2448 #endif

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2449

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2450 if (0==pm) // Check and filter illegal pm value by using last valid IL

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2451 current_IL = IL_info_ptr->input_level;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2452 else

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2453 current_IL = -(pm - (last_known_agc - delta_drp_gain) + lna_value - l1ctl_get_g_magic(radio_freq));

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2454

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2455 current_calibrated_IL = current_IL - delta1_freq - delta2_freq;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2456

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2457 // Protect IL stores against overflow

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2458 if (current_calibrated_IL>INDEX_MAX)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2459 current_calibrated_IL=INDEX_MAX;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2460 if (current_IL>INDEX_MAX)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2461 current_IL=INDEX_MAX;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2462

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2463 l1a_l1s_com.Scell_info.buff_beacon[0] = (UWORD8)current_IL;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2464

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2465 IL_max = l1ctl_find_max(&(l1a_l1s_com.Scell_info.buff_beacon[0]),4);

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2466

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2467 //input levels are always stored with lna_on

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2468 l1ctl_encode_lna( (UWORD8)(current_calibrated_IL>>1),

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2469 &(IL_info_ptr->lna_off),

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2470 radio_freq );

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2471

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2472 IL_info_ptr->input_level = IL_max;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2473

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2474 #if L2_L3_SIMUL

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2475 #if (DEBUG_TRACE==BUFFER_TRACE_PAGC)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2476 buffer_trace(4,IL_info_ptr->input_level,last_known_agc,

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2477 l1a_l1s_com.Scell_used_IL_dd.input_level,Cust_get_agc_from_IL(radio_freq, IL_max >> 1, MAX_ID, l1a_l1s_com.Scell_used_IL_dd.lna_off));

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2478 #endif

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2479 #endif

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2480

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2481 return((UWORD8)current_calibrated_IL);

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2482 }

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2483

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2484 /*-------------------------------------------------------*/

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2485 /* l1ctl_dpagc() */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2486 /*-------------------------------------------------------*/

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2487 /* Description : */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2488 /* =========== */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2489 /* Based on the same principle as the one used for PAGC */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2490 /* algorithm except that we feed 3 different fifo: */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2491 /* 1) one is dedicated to BCCH carrier */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2492 /* 2) another one is dedicated to all the other type of */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2493 /* bursts */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2494 /* 3) the last one is dedicated to non DTX influenced */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2495 /* bursts */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2496 /*-------------------------------------------------------*/

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2497 UWORD8 l1ctl_dpagc(BOOL dtx_on, BOOL beacon, UWORD8 pm, UWORD16 radio_freq, T_INPUT_LEVEL *IL_info_ptr)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2498 {

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2499 UWORD8 av_G_all, av_G_DTX;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2500 UWORD8 max_G_all, max_G_DTX;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2501 WORD32 last_known_agc, new_IL, current_calibrated_IL;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2502 WORD8 delta1_freq, delta2_freq;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2503 WORD16 delta_drp_gain=0;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2504 UWORD8 i;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2505 UWORD8 *tab_ptr;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2506 T_DEDIC_SET *aset;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2507 WORD32 lna_value;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2508 UWORD16 arfcn;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2509 UWORD8 lna_off;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2510 UWORD16 dco_algo_ctl_pw_temp = 0;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2511 UWORD8 if_ctl = 0;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2512 #if (RF_RAM == 61) && (CODE_VERSION != SIMULATION)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2513 UWORD8 if_threshold = C_IF_ZERO_LOW_THRESHOLD_GSM;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2514 #endif

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2515

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2516 delta1_freq = l1ctl_encode_delta1(radio_freq);

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2517 delta2_freq = l1ctl_encode_delta2(radio_freq);

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2518

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2519 aset = l1a_l1s_com.dedic_set.aset;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2520

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2521 if (beacon)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2522 tab_ptr = l1a_l1s_com.Scell_info.buff_beacon;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2523 else

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2524 tab_ptr = aset->G_all;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2525

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2526 // Update fifo

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2527 for (i=DPAGC_FIFO_LEN-1;i>0;i--)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2528 tab_ptr[i]=tab_ptr[i-1];

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2529

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2530 #if TESTMODE

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2531 if (!l1_config.agc_enable)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2532 {

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2533 // AGC gain can only be controlled in 2dB steps as the bottom bit (bit zero)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2534 // corresponds to the lna_off bit

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2535 last_known_agc = (l1_config.tmode.rx_params.agc) << 1;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2536 lna_value = (l1_config.tmode.rx_params.lna_off) * l1ctl_get_lna_att(radio_freq);

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2537 }

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2538 else

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2539 #endif

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2540 {

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2541 #if DPAGC_MAX_FLAG

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2542 last_known_agc = (Cust_get_agc_from_IL(radio_freq, l1a_l1s_com.Scell_used_IL_dd.input_level >> 1, MAX_ID,l1a_l1s_com.Scell_used_IL_dd.lna_off)) << 1;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2543 // F7.1 in order to be compatible with pm and IL formats

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2544 #else

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2545 last_known_agc = (Cust_get_agc_from_IL(radio_freq, l1a_l1s_com.Scell_used_IL_dd.input_level >> 1, AV_ID,l1a_l1s_com.Scell_used_IL_dd.lna_off)) << 1;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2546 // F7.1 in order to be compatible with pm and IL formats

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2547 #endif

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2548 // input_level_dd : contain the input_level value we use

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2549 // in the associated CTL task to build the agc used in this CTL.

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2550

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2551 lna_value = l1a_l1s_com.Scell_used_IL_dd.lna_off * l1ctl_get_lna_att(radio_freq);

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2552 }

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2553

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2554 #if (L1_FF_MULTIBAND == 0)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2555 arfcn = Convert_l1_radio_freq(radio_freq);

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2556 #else

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2557 arfcn=radio_freq;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2558 #endif

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2559

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2560 #if(RF_FAM == 61)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2561 #if (CODE_VERSION != SIMULATION)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2562

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2563 cust_get_if_dco_ctl_algo(&dco_algo_ctl_pw_temp, &if_ctl, (UWORD8) L1_IL_VALID ,

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2564 l1a_l1s_com.Scell_used_IL_dd.input_level,

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2565 radio_freq,if_threshold);

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2566 lna_off = l1a_l1s_com.Scell_used_IL_dd.lna_off;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2567 delta_drp_gain = drp_gain_correction(arfcn, lna_off, last_known_agc); // F7.1 format

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2568 if(if_ctl == IF_100KHZ_DSP){

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2569 delta_drp_gain += SCF_ATTENUATION_LIF_100KHZ;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2570 }

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2571 else{ /* i.e. if_ctl = IF_120KHZ_DSP*/

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2572 delta_drp_gain += SCF_ATTENUATION_LIF_120KHZ;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2573 }

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2574

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2575 #endif

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2576 #endif

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2577

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2578 if (0==pm) // Check and filter illegal pm value by using last valid IL

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2579 new_IL = IL_info_ptr->input_level;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2580 else

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2581 new_IL = -(pm - (last_known_agc - delta_drp_gain) + lna_value - l1ctl_get_g_magic(radio_freq));

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2582

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2583 current_calibrated_IL = new_IL - delta1_freq - delta2_freq;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2584

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2585 // Protect IL stores against overflow

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2586 if (current_calibrated_IL>INDEX_MAX)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2587 current_calibrated_IL=INDEX_MAX;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2588

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2589 #if TESTMODE

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2590 if (l1tm.tmode_state.dedicated_active) // Implies l1_config.TestMode = 1

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2591 {

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2592 // Update l1tm.tmode_stats.rssi_fifo (delay line from index 3 to 0)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2593 for (i=(sizeof(l1tm.tmode_stats.rssi_fifo)/sizeof(l1tm.tmode_stats.rssi_fifo[0]))-1; i>0; i--)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2594 {

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2595 l1tm.tmode_stats.rssi_fifo[i] = l1tm.tmode_stats.rssi_fifo[i-1];

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2596 }

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2597 l1tm.tmode_stats.rssi_fifo[0] = current_calibrated_IL; // rssi value is F7.1

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2598 l1tm.tmode_stats.rssi_recent = current_calibrated_IL; // rssi value is F7.1

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2599 }

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2600 #endif

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2601

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2602 if (new_IL>INDEX_MAX)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2603 new_IL=INDEX_MAX;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2604

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2605 tab_ptr[0] = (UWORD8)new_IL;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2606

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2607 if (dtx_on && !beacon)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2608 {

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2609 // Update DTX fifo

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2610 for (i=DPAGC_FIFO_LEN-1;i>0;i--)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2611 aset->G_DTX[i]=aset->G_DTX[i-1];

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2612

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2613 aset->G_DTX[0]=tab_ptr[0];

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2614 }

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2615

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2616 /* Computation of MAX{G_all[i],G_DTX[j]} i,j=0..3 */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2617 #if DPAGC_MAX_FLAG

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2618 max_G_all = l1ctl_find_max(&(tab_ptr[0]),DPAGC_FIFO_LEN);

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2619

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2620 if (!beacon)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2621 {

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2622 max_G_DTX = l1ctl_find_max(&(aset->G_DTX[0]),DPAGC_FIFO_LEN);

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2623

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2624 // WARNING: for array index purpose we work with POSITIVE input level

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2625 // so maximum search for negative numbers is equivalent to

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2626 // minimum search for positive numbers!!!!!!

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2627 // (-30 > -120 but 30 < 120)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2628 if (max_G_all <= max_G_DTX)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2629 new_IL = max_G_all;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2630 else

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2631 new_IL = max_G_DTX;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2632 }

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2633 else

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2634 new_IL = max_G_all;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2635 #else

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2636 av_G_all=av_G_DTX=0;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2637

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2638 for (i=0;i<DPAGC_FIFO_LEN;i++)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2639 av_G_all += tab_ptr[i];

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2640

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2641 av_G_all /= DPAGC_FIFO_LEN;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2642

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2643 if (!beacon)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2644 {

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2645 for (i=0;i<DPAGC_FIFO_LEN;i++)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2646 av_G_DTX += aset->G_DTX[i];

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2647

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2648 av_G_DTX /= DPAGC_FIFO_LEN;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2649

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2650 if (av_G_all >= av_G_DTX)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2651 new_IL = av_G_all;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2652 else

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2653 new_IL = av_G_DTX;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2654 }

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2655 else

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2656 new_IL = av_G_all;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2657 #endif

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2658

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2659 // Updating of input_level and lna_off fields in order to correctly

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2660 // setting the AGC for the next task.

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2661 // input_level is always store with lna_on

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2662 l1ctl_encode_lna( (UWORD8)(current_calibrated_IL>>1),

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2663 &(IL_info_ptr->lna_off),

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2664 radio_freq );

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2665

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2666 IL_info_ptr->input_level = (UWORD8)new_IL ;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2667

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2668 #if L2_L3_SIMUL

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2669 #if (DEBUG_TRACE==BUFFER_TRACE_DPAGC)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2670 buffer_trace(4,IL_info_ptr->input_level,last_known_agc,

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2671 l1a_l1s_com.Scell_used_IL_dd.input_level,Cust_get_agc_from_IL(radio_freq, new_IL >> 1, MAX_ID,l1a_l1s_com.Scell_used_IL_dd.lna_off));

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2672 #endif

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2673 #endif

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2674

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2675 return((UWORD8)current_calibrated_IL);

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2676 }

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2677

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2678 #if (AMR == 1)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2679 /*-------------------------------------------------------*/

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2680 /* l1ctl_dpagc_amr() */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2681 /*-------------------------------------------------------*/

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2682 /* Description : */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2683 /* =========== */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2684 /* Based on the same principle as the one used for DPAGC */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2685 /* algorithm except that the way to feed the G_dtx is */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2686 /* different */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2687 /*-------------------------------------------------------*/

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2688 UWORD8 l1ctl_dpagc_amr(BOOL dtx_on, BOOL beacon, UWORD8 pm, UWORD16 radio_freq, T_INPUT_LEVEL *IL_info_ptr)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2689 {

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2690 UWORD8 av_G_all, av_G_DTX;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2691 UWORD8 max_G_all, max_G_DTX, max_il;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2692 WORD32 last_known_agc, new_IL, current_calibrated_IL;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2693 WORD8 delta1_freq, delta2_freq;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2694 WORD16 delta_drp_gain=0;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2695 UWORD8 i;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2696 UWORD8 *tab_ptr, *tab_amr_ptr;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2697 T_DEDIC_SET *aset;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2698 WORD32 lna_value;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2699 UWORD16 arfcn;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2700 UWORD8 lna_off;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2701 UWORD16 dco_algo_ctl_pw_temp = 0;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2702 UWORD8 if_ctl = 0;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2703 #if (RF_RAM == 61) && (CODE_VERSION != SIMULATION)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2704 UWORD8 if_threshold = C_IF_ZERO_LOW_THRESHOLD_GSM;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2705 #endif

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2706

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2707 delta1_freq = l1ctl_encode_delta1(radio_freq);

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2708 delta2_freq = l1ctl_encode_delta2(radio_freq);

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2709

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2710 aset = l1a_l1s_com.dedic_set.aset;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2711

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2712 if (beacon)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2713 tab_ptr = l1a_l1s_com.Scell_info.buff_beacon;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2714 else

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2715 tab_ptr = aset->G_all;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2716

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2717 // Update fifo

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2718 for (i=DPAGC_FIFO_LEN-1;i>0;i--)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2719 tab_ptr[i]=tab_ptr[i-1];

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2720

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2721 tab_amr_ptr = aset->G_amr;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2722 for (i=DPAGC_AMR_FIFO_LEN-1;i>0;i--)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2723 tab_amr_ptr[i]=tab_amr_ptr[i-1];

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2724

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2725 #if TESTMODE

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2726 if (!l1_config.agc_enable)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2727 {

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2728 // AGC gain can only be controlled in 2dB steps as the bottom bit (bit zero)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2729 // corresponds to the lna_off bit

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2730 last_known_agc = (l1_config.tmode.rx_params.agc) << 1;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2731 lna_value = (l1_config.tmode.rx_params.lna_off) * l1ctl_get_lna_att(radio_freq);

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2732 }

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2733 else

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2734 #endif

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2735 {

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2736 #if DPAGC_MAX_FLAG

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2737 last_known_agc = (Cust_get_agc_from_IL(radio_freq, l1a_l1s_com.Scell_used_IL_dd.input_level >> 1, MAX_ID,l1a_l1s_com.Scell_used_IL_dd.lna_off)) << 1;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2738 // F7.1 in order to be compatible with pm and IL formats

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2739 #else

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2740 last_known_agc = (Cust_get_agc_from_IL(radio_freq, l1a_l1s_com.Scell_used_IL_dd.input_level >> 1, AV_ID,l1a_l1s_com.Scell_used_IL_dd.lna_off)) << 1;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2741 // F7.1 in order to be compatible with pm and IL formats

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2742 #endif

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2743 // input_level_dd : contain the input_level value we use

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2744 // in the associated CTL task to build the agc used in this CTL.

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2745

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2746 lna_value = l1a_l1s_com.Scell_used_IL_dd.lna_off * l1ctl_get_lna_att(radio_freq);

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2747 }

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2748

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2749 #if (L1_FF_MULTIBAND == 0)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2750 arfcn = Convert_l1_radio_freq(radio_freq);

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2751 #else

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2752 arfcn=radio_freq;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2753 #endif

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2754

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2755 #if(RF_FAM == 61)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2756 #if (CODE_VERSION != SIMULATION)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2757 cust_get_if_dco_ctl_algo(&dco_algo_ctl_pw_temp, &if_ctl, (UWORD8) L1_IL_VALID ,

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2758 l1a_l1s_com.Scell_used_IL_dd.input_level,

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2759 radio_freq,if_threshold);

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2760 lna_off = l1a_l1s_com.Scell_used_IL_dd.lna_off;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2761 delta_drp_gain = drp_gain_correction(arfcn, lna_off, last_known_agc); // F7.1 format

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2762 if(if_ctl == IF_100KHZ_DSP){

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2763 delta_drp_gain += SCF_ATTENUATION_LIF_100KHZ;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2764 }

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2765 else{ /* i.e. if_ctl = IF_120KHZ_DSP*/

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2766 delta_drp_gain += SCF_ATTENUATION_LIF_120KHZ;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2767 }

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2768 #endif

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2769 #endif

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2770

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2771 if (0==pm) // Check and filter illegal pm value by using last valid IL

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2772 new_IL = IL_info_ptr->input_level;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2773 else

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2774 new_IL = -(pm - (last_known_agc - delta_drp_gain) + lna_value - l1ctl_get_g_magic(radio_freq));

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2775

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2776 current_calibrated_IL = new_IL - delta1_freq - delta2_freq;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2777

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2778 // Protect IL stores against overflow

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2779 if (current_calibrated_IL>INDEX_MAX)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2780 current_calibrated_IL=INDEX_MAX;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2781

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2782 #if TESTMODE

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2783 if (l1tm.tmode_state.dedicated_active) // Implies l1_config.TestMode = 1

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2784 {

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2785 // Update l1tm.tmode_stats.rssi_fifo (delay line from index 3 to 0)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2786 for (i=(sizeof(l1tm.tmode_stats.rssi_fifo)/sizeof(l1tm.tmode_stats.rssi_fifo[0]))-1; i>0; i--)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2787 {

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2788 l1tm.tmode_stats.rssi_fifo[i] = l1tm.tmode_stats.rssi_fifo[i-1];

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2789 }

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2790 l1tm.tmode_stats.rssi_fifo[0] = current_calibrated_IL; // rssi value is F7.1

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2791 l1tm.tmode_stats.rssi_recent = current_calibrated_IL; // rssi value is F7.1

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2792 }

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2793 #endif

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2794

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2795 if (new_IL>INDEX_MAX)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2796 new_IL=INDEX_MAX;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2797

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2798 tab_ptr[0] = (UWORD8)new_IL;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2799 tab_amr_ptr[0] = (UWORD8)new_IL;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2800

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2801 if (dtx_on && !beacon)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2802 {

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2803 // a new AMR block is received, feed the G_dtx with the max_il of the block

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2804 for (i=DPAGC_FIFO_LEN-1;i>0;i--)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2805 aset->G_DTX[i]=aset->G_DTX[i-1];

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2806

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2807 if (l1a_l1s_com.dedic_set.aset->achan_ptr->mode == TCH_AHS_MODE)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2808 {

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2809 // Keep the max_il between the last 2 bursts

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2810 if (aset->G_amr[0] > aset->G_amr[1])

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2811 max_il = aset->G_amr[0];

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2812 else

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2813 max_il = aset->G_amr[1];

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2814 }

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2815 else

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2816 {

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2817 // Keep the max_il between the last 4 bursts

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2818 max_il = l1ctl_find_max(&aset->G_amr[0], DPAGC_AMR_FIFO_LEN);

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2819 }

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2820

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2821 aset->G_DTX[0]= max_il;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2822 }

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2823

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2824 /* Computation of MAX{G_all[i],G_DTX[j]} i,j=0..3 */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2825 #if DPAGC_MAX_FLAG

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2826 max_G_all = l1ctl_find_max(&(tab_ptr[0]),DPAGC_FIFO_LEN);

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2827

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2828 if (!beacon)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2829 {

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2830 max_G_DTX = l1ctl_find_max(&(aset->G_DTX[0]),DPAGC_FIFO_LEN);

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2831

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2832 // WARNING: for array index purpose we work with POSITIVE input level

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2833 // so maximum search for negative numbers is equivalent to

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2834 // minimum search for positive numbers!!!!!!

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2835 // (-30 > -120 but 30 < 120)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2836 if (max_G_all <= max_G_DTX)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2837 new_IL = max_G_all;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2838 else

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2839 new_IL = max_G_DTX;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2840 }

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2841 else

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2842 new_IL = max_G_all;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2843 #else

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2844 av_G_all=av_G_DTX=0;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2845

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2846 for (i=0;i<DPAGC_FIFO_LEN;i++)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2847 av_G_all += tab_ptr[i];

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2848

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2849 av_G_all /= DPAGC_FIFO_LEN;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2850

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2851 if (!beacon)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2852 {

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2853 for (i=0;i<DPAGC_FIFO_LEN;i++)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2854 av_G_DTX += aset->G_DTX[i];

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2855

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2856 av_G_DTX /= DPAGC_FIFO_LEN;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2857

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2858 if (av_G_all >= av_G_DTX)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2859 new_IL = av_G_all;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2860 else

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2861 new_IL = av_G_DTX;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2862 }

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2863 else

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2864 new_IL = av_G_all;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2865 #endif

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2866

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2867 // Updating of input_level and lna_off fields in order to correctly

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2868 // setting the AGC for the next task.

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2869 // input_level is always store with lna_on

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2870

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2871 l1ctl_encode_lna( (UWORD8)(current_calibrated_IL>>1),

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2872 &(IL_info_ptr->lna_off),

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2873 radio_freq );

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2874 IL_info_ptr->input_level = (UWORD8)new_IL ;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2875

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2876 #if L2_L3_SIMUL

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2877 #if (DEBUG_TRACE==BUFFER_TRACE_DPAGC)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2878 buffer_trace(4,IL_info_ptr->input_level,last_known_agc,

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2879 l1a_l1s_com.Scell_used_IL_dd.input_level,Cust_get_agc_from_IL(radio_freq, new_IL >> 1, MAX_ID,l1a_l1s_com.Scell_used_IL_dd.lna_off));

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2880 #endif

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2881 #endif

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2882

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2883 return((UWORD8)current_calibrated_IL);

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2884 }

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2885 #endif // AMR == 1

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2886

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2887 /*-------------------------------------------------------*/

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2888 /* l1ctl_get_g_magic() */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2889 /*-------------------------------------------------------*/

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2890 /* Parameters : */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2891 /* Return : */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2892 /* Functionality : */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2893 /*-------------------------------------------------------*/

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2894 #if (L1_FF_MULTIBAND == 0)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2895 UWORD16 l1ctl_get_g_magic(UWORD16 radio_freq)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2896 {

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2897

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2898

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2899 if ((l1_config.std.id == DUAL) || (l1_config.std.id == DUALEXT) || (l1_config.std.id == DUAL_US))

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2900 {

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2901 if (radio_freq >= l1_config.std.first_radio_freq_band2)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2902 return(l1_config.std.g_magic_band2);

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2903 else

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2904 return(l1_config.std.g_magic_band1);

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2905 }

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2906 else

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2907 return(l1_config.std.g_magic_band1);

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2908

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2909

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2910 }

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2911 #endif

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2912

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2913 /*-------------------------------------------------------*/

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2914 /* l1ctl_get_lna_att() */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2915 /*-------------------------------------------------------*/

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2916 /* Parameters : */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2917 /* Return : */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2918 /* Functionality : */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2919 /*-------------------------------------------------------*/

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2920 #if (L1_FF_MULTIBAND == 0)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2921 UWORD16 l1ctl_get_lna_att(UWORD16 radio_freq)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2922 {

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2923

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2924

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2925 if ((l1_config.std.id == DUAL) || (l1_config.std.id == DUALEXT) || (l1_config.std.id == DUAL_US))

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2926 {

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2927 if (radio_freq >= l1_config.std.first_radio_freq_band2)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2928 return(l1_config.std.lna_att_band2);

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2929 else

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2930 return(l1_config.std.lna_att_band1);

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2931 }

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2932 else

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2933 return(l1_config.std.lna_att_band1);

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2934

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2935

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2936 }

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2937 #endif

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2938 /*-------------------------------------------------------*/

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2939 /* l1ctl_update_TPU_with_toa() */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2940 /*-------------------------------------------------------*/

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2941 /* Parameters : */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2942 /* Return : */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2943 /* Functionality : */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2944 /*-------------------------------------------------------*/

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2945 UWORD16 l1ctl_update_TPU_with_toa(void)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2946 {

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2947 #if (TOA_ALGO != 0)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2948 WORD16 toa_shift;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2949

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2950 #if (TOA_ALGO == 2)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2951 toa_shift = l1s.toa_var.toa_shift;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2952 #else

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2953 toa_shift = l1s.toa_shift;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2954 #endif

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2955

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2956 if (toa_shift != ISH_INVALID)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2957 // New ISH (TOA shift) has been stored in "l1s.toa_shift".

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2958 {

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2959 // NEW !!! For EOTD measurements in IDLE mode, cut AFC updates...

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2960 #if (L1_EOTD==1)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2961 #if (L1_GPRS)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2962 if ( (l1a_l1s_com.nsync.eotd_meas_session == FALSE) ||

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2963 (l1a_l1s_com.mode == DEDIC_MODE)||

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2964 (l1a_l1s_com.l1s_en_task[PDTCH] == TASK_ENABLED))

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2965 #else

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2966 if ( (l1a_l1s_com.nsync.eotd_meas_session == FALSE) ||

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2967 (l1a_l1s_com.mode == DEDIC_MODE))

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2968 #endif

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2969 {

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2970 // In dedicated or transfer modes we need to track an TOA

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2971 // updates to post correct th results, else E-OTD implementation

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2972 // has qb errors...

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2973

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2974 if( (l1a_l1s_com.nsync.eotd_meas_session == TRUE)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2975 && (l1a_l1s_com.nsync.eotd_toa_phase == 1) )

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2976 {

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2977 l1a_l1s_com.nsync.eotd_toa_tracking += toa_shift;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2978 }

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2979 #endif

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2980 // Update tpu offset.

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2981 l1s.tpu_offset = (l1s.tpu_offset + TPU_CLOCK_RANGE + toa_shift) % TPU_CLOCK_RANGE;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2982

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2983 #if (TRACE_TYPE==1) || (TRACE_TYPE==4)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2984 #if (GSM_IDLE_RAM == 0)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2985 l1_trace_new_toa();

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2986 #else

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2987 l1_trace_new_toa_intram();

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2988 #endif

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2989 #endif

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2990

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2991 #if (L1_EOTD==1)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2992 }

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2993 #endif

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2994

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2995 #if (TRACE_TYPE == 5)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2996 #if (TOA_ALGO == 2)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2997 trace_toa_sim_update (toa_shift,l1s.tpu_offset);

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2998 #endif

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2999 #endif

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

3000

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

3001 // Reset ISH.

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

3002 #if (TOA_ALGO == 2)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

3003 l1s.toa_var.toa_shift = ISH_INVALID; // Reset the ISH.

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

3004 #else

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

3005 l1s.toa_shift = ISH_INVALID; // Reset the ISH.

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

3006 #endif

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

3007 }

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

3008 #endif

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

3009 return 0; //omaps00090550

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

3010 }

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

3011

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

3012

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

3013 /*-------------------------------------------------------*/

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

3014 /* l1ctl_saic() */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

3015 /*-------------------------------------------------------*/

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

3016 /* Parameters : */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

3017 /* Return : */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

3018 /* Functionality : */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

3019 /*-------------------------------------------------------*/

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

3020

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

3021 #if (L1_SAIC != 0)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

3022 #define SWH_CHANTAP_INIT 0xFFD068CE

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

3023 #if (NEW_SNR_THRESHOLD == 1)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

3024 UWORD8 l1ctl_saic (UWORD8 IL_for_rxlev, UWORD32 l1_mode, UWORD8 task, UWORD8 * saic_flag)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

3025 #else

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

3026 UWORD8 l1ctl_saic (UWORD8 IL_for_rxlev, UWORD32 l1_mode)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

3027 #endif /* NEW_SNR_THRESHOLD */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

3028 {

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

3029 UWORD16 SWH_flag = 0;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

3030 UWORD8 CSF_Filter_choice = L1_SAIC_HARDWARE_FILTER;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

3031 #if (NEW_SNR_THRESHOLD == 0)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

3032 volatile UWORD16 *ptr;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

3033 UWORD8 saic_flag;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

3034 #endif /* NEW_SNR_THRESHOLD */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

3035 #if (NEW_SNR_THRESHOLD == 0)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

3036 ptr = (volatile UWORD16 * ) (SWH_CHANTAP_INIT);

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

3037 *ptr = 0;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

3038 saic_flag=1;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

3039 #else

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

3040 *saic_flag=0;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

3041 #endif

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

3042

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

3043 switch (l1_mode)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

3044 {

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

3045 case DEDIC_MODE: // GSM DEDICATED MODE

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

3046 {

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

3047 #if (NEW_SNR_THRESHOLD == 1)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

3048 *saic_flag=1;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

3049 #endif

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

3050 if(IL_for_rxlev < L1_SAIC_GENIE_GSM_DEDIC_THRESHOLD)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

3051 {

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

3052 SWH_flag=1;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

3053 }

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

3054

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

3055 break;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

3056 }

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

3057 #if L1_GPRS

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

3058 case PACKET_TRANSFER_MODE: // PACKET TRANSFER MODE

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

3059 {

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

3060 #if (NEW_SNR_THRESHOLD == 0)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

3061 #if (L1_SAIC == 1)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

3062 if(IL_for_rxlev < L1_SAIC_GENIE_GPRS_PCKT_TRAN_THRESHOLD)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

3063 {

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

3064 *ptr = 4;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

3065 }

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

3066 #endif /*#if (L1_SAIC == 3)*/

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

3067 #endif

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

3068

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

3069 #if (L1_SAIC == 3)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

3070 if(IL_for_rxlev < L1_SAIC_GENIE_GPRS_PCKT_TRAN_THRESHOLD)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

3071 {

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

3072 SWH_flag = 1;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

3073 }

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

3074 #endif /*#if (L1_SAIC == 3)*/

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

3075 break;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

3076 }

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

3077 #endif /*#if L1_GPRS*/

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

3078 default: /* GSM OR GPRS IDLE MODES */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

3079 {

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

3080 #if ((L1_SAIC == 2)||(L1_SAIC == 3))

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

3081 if(IL_for_rxlev < L1_SAIC_GENIE_GSM_GPRS_IDLE_THRESHOLD)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

3082 {

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

3083 SWH_flag=1;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

3084 }

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

3085 #endif

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

3086 break;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

3087 }

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

3088 }

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

3089

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

3090 l1ddsp_load_swh_flag (SWH_flag ,

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

3091 #if (NEW_SNR_THRESHOLD == 0)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

3092 saic_flag

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

3093 #else

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

3094 *saic_flag

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

3095 #endif

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

3096 );

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

3097

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

3098 if(SWH_flag == 1)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

3099 {

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

3100 CSF_Filter_choice = L1_SAIC_PROGRAMMABLE_FILTER;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

3101 }

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

3102

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

3103

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

3104 #if (TRACE_TYPE == 1) || (TRACE_TYPE == 4)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

3105 l1_trace_saic(SWH_flag,

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

3106 #if (NEW_SNR_THRESHOLD == 0)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

3107 saic_flag

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

3108 #else

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

3109 *saic_flag

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

3110 #endif

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

3111 );

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

3112 #endif

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

3113 #if (TRACE_TYPE == 5)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

3114 trace_saic_sim(IL_for_rxlev, l1_mode, SWH_flag);

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

3115 #endif

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

3116

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

3117 return(CSF_Filter_choice);

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

3118 }

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

3119 #endif

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

3120

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

3121 #if (FF_L1_FAST_DECODING == 1)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

3122 /*-----------------------------------------------------------------*/

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

3123 /* l1ctl_pagc_missing_bursts */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

3124 /*-----------------------------------------------------------------*/

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

3125 /* */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

3126 /* Description: */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

3127 /* ------------ */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

3128 /* When fast decoding is active, fewer bursts are decoded. As a */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

3129 /* result, fewer gain values are available. The PAGC algo must */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

3130 /* be updated with the missed values. */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

3131 /* */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

3132 /* Input parameters: */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

3133 /* ----------------- */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

3134 /* UWORD8 skipped_values: the number of skipped bursts due to fast */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

3135 /* decoding. */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

3136 /* */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

3137 /* Input parameters from globals: */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

3138 /* ------------------------------ */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

3139 /* l1a_l1s_com.Scell_info.buff_beacon: Input Level (IL) FIFO */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

3140 /* l1_config.params.il_min: minimum level */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

3141 /* */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

3142 /* Output parameters: */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

3143 /* ------------------ */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

3144 /* none */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

3145 /* */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

3146 /* Modified parameters from globals: */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

3147 /* --------------------------------- */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

3148 /* l1a_l1s_com.Scell_info.buff_beacon: Input Level (IL) FIFO */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

3149 /* */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

3150 /*-----------------------------------------------------------------*/

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

3151

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

3152 void l1ctl_pagc_missing_bursts (UWORD8 skipped_values)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

3153 {

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

3154 UWORD8 i = 0;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

3155

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

3156 /* skipped_values cannot be greater than 3, otherwise this is an error

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

3157 * and the PAGC algorithm mustn't be updated. */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

3158 if (skipped_values > 3)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

3159 {

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

3160 return;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

3161 }

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

3162

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

3163 /* Update fifo by removing skipped_values of samples */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

3164 for (i = 3; i > (skipped_values - 1); i--)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

3165 {

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

3166 l1a_l1s_com.Scell_info.buff_beacon[i] = l1a_l1s_com.Scell_info.buff_beacon[i-skipped_values];

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

3167 }

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

3168

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

3169 /* Insert minimum IL level as many times a burst has been skipped */

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

3170 for (i = 0; i < skipped_values; i++)

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

3171 {

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

3172 l1a_l1s_com.Scell_info.buff_beacon[i] = l1_config.params.il_min;

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

3173 }

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

3174 }

75a11d740a02 initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

3175 #endif /* #if (FF_L1_FAST_DECODING == 1) */

FreeCalypso > hg > freecalypso-citrine

annotate L1/cfile/l1_ctl.c @ 0:75a11d740a02