fc-magnetite: src/cs/layer1/cfile/l1

annotate src/cs/layer1/cfile/l1_ctl.c @ 640:16eb1b9640dc

target gtm900 renamed to gtm900mgc2 This change reflects the fact that the build target in question supports MGC2GSMT hardware only, and will NOT work on other hw that confusing bears the same end user name of GTM900, neither the LoCosto-based GTM900-C nor the Calypso-based MG01GSMT that has a different and incompatible RFFE. If we ever get our hands on a piece of MG01GSMT hw and add support for it, that other target will be named gtm900mg01.

author	Mychaela Falconia <falcon@freecalypso.org>
date	Fri, 31 Jan 2020 00:46:07 +0000
parents	af1bacf61dc6
children

rev	line source
69 50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1 /*********** Revision Controle System Header ***********
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2 * GSM Layer 1 software
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	3 * L1_CTL.C
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	4 *
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	5 * Filename l1_ctl.c
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	6 * Copyright 2003 (C) Texas Instruments
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	7 *
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	8 *********** Revision Controle System Header ***********/
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	9
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	10 #define L1_CTL_C
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	11
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	12 #include "l1_macro.h"
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	13 #include "l1_confg.h"
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	14
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	15 #if (CODE_VERSION == SIMULATION)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	16 #include <string.h>
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	17 #include "l1_types.h"
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	18 #include "sys_types.h"
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	19 #include "l1_const.h"
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	20 #include "l1_time.h"
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	21 #include "l1_signa.h"
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	22
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	23 #if TESTMODE
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	24 #include "l1tm_defty.h"
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	25 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	26 #if (AUDIO_TASK == 1)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	27 #include "l1audio_const.h"
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	28 #include "l1audio_cust.h"
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	29 #include "l1audio_signa.h"
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	30 #include "l1audio_defty.h"
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	31 #include "l1audio_msgty.h"
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	32 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	33 #if (L1_GTT == 1)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	34 #include "l1gtt_const.h"
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	35 #include "l1gtt_defty.h"
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	36 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	37 #if (L1_MP3 == 1)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	38 #include "l1mp3_defty.h"
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	39 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	40 #if (L1_MIDI == 1)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	41 #include "l1midi_defty.h"
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	42 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	43 //ADDED FOR AAC
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	44 #if (L1_AAC == 1)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	45 #include "l1aac_defty.h"
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	46 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	47 #include "l1_defty.h"
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	48 #include "cust_os.h"
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	49 #include "l1_msgty.h"
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	50 #include "l1_varex.h"
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	51 #include "l1_proto.h"
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	52 #include "l1_mftab.h"
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	53 #include "l1_tabs.h"
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	54 #include "l1_ver.h"
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	55 #if L2_L3_SIMUL
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	56 #include "hw_debug.h"
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	57 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	58
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	59 #if TESTMODE
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	60 #include "l1tm_msgty.h"
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	61 #include "l1tm_varex.h"
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	62 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	63
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	64 #include "l1_ctl.h"
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	65
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	66 #ifdef _INLINE
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	67 #define INLINE static inline // Inline functions when -v option is set
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	68 #else // when the compiler is ivoked.
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	69 #define INLINE
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	70 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	71 #else
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	72 #include <string.h>
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	73 #include "l1_types.h"
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	74 #include "sys_types.h"
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	75 #include "l1_const.h"
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	76 #include "l1_time.h"
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	77 #include "l1_signa.h"
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	78
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	79 #if (RF_FAM == 61)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	80 #include "tpudrv61.h"
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	81 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	82
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	83 #if TESTMODE
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	84 #include "l1tm_defty.h"
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	85 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	86 #if (AUDIO_TASK == 1)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	87 #include "l1audio_const.h"
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	88 #include "l1audio_cust.h"
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	89 #include "l1audio_defty.h"
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	90 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	91 #if (L1_GTT == 1)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	92 #include "l1gtt_const.h"
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	93 #include "l1gtt_defty.h"
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	94 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	95 #if (L1_MP3 == 1)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	96 #include "l1mp3_defty.h"
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	97 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	98 #if (L1_MIDI == 1)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	99 #include "l1midi_defty.h"
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	100 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	101 //ADDED FOR AAC
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	102 #if (L1_AAC == 1)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	103 #include "l1aac_defty.h"
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	104 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	105 #include "l1_defty.h"
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	106 #include "cust_os.h"
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	107 #include "l1_msgty.h"
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	108 #include "l1_varex.h"
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	109 #include "l1_proto.h"
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	110 #include "l1_tabs.h"
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	111 #include "l1_ctl.h"
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	112 #if L2_L3_SIMUL
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	113 #include "hw_debug.h"
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	114 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	115
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	116 #if TESTMODE
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	117 #include "l1tm_msgty.h"
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	118 #include "l1tm_varex.h"
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	119 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	120 #ifdef _INLINE
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	121 #define INLINE static inline // Inline functions when -v option is set
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	122 #else // when the compiler is ivoked.
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	123 #define INLINE
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	124 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	125 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	126
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	127 #if(RF_FAM == 61)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	128 #include "l1_rf61.h"
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	129 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	130
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	131 #if (TRACE_TYPE == 1) \|\| (TRACE_TYPE == 4)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	132 #include "l1_trace.h"
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	133 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	134
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	135 extern SYS_UWORD16 Convert_l1_radio_freq(SYS_UWORD16 radio_freq);
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	136 #if(RF_FAM == 61)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	137 extern WORD16 drp_gain_correction(UWORD16 arfcn, UWORD8 lna_off, UWORD16 agc);
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	138 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	139
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	140 #define LNA_OFF 1
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	141 #define LNA_ON 0
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	142
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	143
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	144
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	145
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	146 /************************************/
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	147 /* Automatic frequency compensation */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	148 /************************************/
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	149
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	150 /*
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	151 * FreeCalypso TCS211 reconstruction: the following 3 functions
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	152 * have been added in the LoCosto version of this module.
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	153 * We have conditioned them out in order to match the original
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	154 * TCS211 object; their uses have been conditioned out as well.
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	155 *
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	156 * These functions will need to re-enabled when their uses are
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	157 * re-enabled.
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	158 */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	159
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	160 #if 0
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	161
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	162 #define L1_WORD16_POS_MAX (32767)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	163 #define L1_WORD16_NEG_MAX (-32768)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	164 #define L1_WORD32_POS_MAX ((unsigned long)(1<<31)-1)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	165 #define L1_WORD32_NEG_MAX (-(unsigned long)(1<<31))
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	166
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	167 INLINE WORD16 Add_Sat_sign_16b(WORD16 val1, WORD16 val2)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	168 {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	169 WORD32 temp;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	170 WORD16 result;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	171
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	172 temp = (WORD32)((WORD32)val1 + (WORD32)val2);
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	173 if(temp > L1_WORD16_POS_MAX)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	174 {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	175 temp = L1_WORD16_POS_MAX;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	176 }
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	177 if(temp < L1_WORD16_NEG_MAX)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	178 {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	179 temp = L1_WORD16_NEG_MAX;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	180 }
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	181 result = (WORD16)((temp)&(0x0000FFFF));
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	182 return(result);
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	183 }
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	184
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	185 INLINE WORD32 Add_Sat_sign_32b(WORD32 val1, WORD32 val2)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	186 {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	187 WORD32 temp_high_high;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	188 UWORD32 temp_low_low;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	189 UWORD16 carry;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	190 WORD32 result;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	191 WORD16 high_val1, high_val2;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	192 UWORD16 low_val1, low_val2;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	193
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	194 high_val1 = (WORD16)(val1>>16);
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	195 high_val2 = (WORD16)(val2>>16);
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	196 low_val1 = (UWORD16)(val1&0x0000FFFF);
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	197 low_val2 = (UWORD16)(val2&0x0000FFFF);
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	198
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	199 temp_high_high = (WORD32)high_val1 + (WORD32)high_val2;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	200 temp_low_low = (UWORD32)low_val1 + (UWORD32)low_val2;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	201 carry = (UWORD16)(temp_low_low >> 16);
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	202 temp_high_high = temp_high_high + (UWORD32)(carry);
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	203
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	204
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	205 result = val1 + val2;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	206 if(temp_high_high > L1_WORD16_POS_MAX)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	207 {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	208 result = L1_WORD32_POS_MAX;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	209 }
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	210 if(temp_high_high < L1_WORD16_NEG_MAX)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	211 {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	212 result = L1_WORD32_NEG_MAX;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	213 }
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	214
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	215 return(result);
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	216 }
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	217
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	218 INLINE WORD32 Sat_Mult_20sign_16unsign(WORD32 val1, UWORD32 val2)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	219 {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	220 WORD32 result;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	221
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	222 result = val1 * val2;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	223 if(val1>0) /* val2 is > 0*/
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	224 {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	225 if(result < 0) /* overflow */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	226 {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	227 result = L1_WORD32_POS_MAX;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	228 }
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	229 }
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	230 if(val1<0) /* val2 is > 0*/
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	231 {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	232 if(result > 0) /* overflow */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	233 {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	234 result = L1_WORD32_NEG_MAX;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	235 }
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	236 }
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	237 return(result);
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	238 }
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	239 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	240
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	241 INLINE WORD32 Add_40b( WORD32 guard1guard2, WORD32 lvar1, WORD32 lvar2, WORD16 *guardout )
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	242 {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	243 WORD32 result, temp, carry, Lvar1, Lvar2;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	244 WORD16 guard1,guard2;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	245
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	246 guard1=(WORD16) ((WORD32) guard1guard2>>16);
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	247 guard2=(WORD16) guard1guard2;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	248
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	249 /* lvar1 and lvar2 are both 48 bits variables */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	250 /* We 1st add the low parts of lvar1 and lvar2 and we give */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	251 /* a 32 bits result and a carry if needed */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	252 Lvar1 = (UWORD16)lvar1;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	253 Lvar2 = (UWORD16)lvar2;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	254
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	255 temp = Lvar1 + Lvar2;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	256
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	257 carry = temp >> 16;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	258
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	259 result = temp & 0x0000ffffL;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	260
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	261 /* We now add the two high parts of var1 and var2 (scaled */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	262 /* to a 16 bits format) and carry (if any) and we give a */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	263 /* 48 bits results. */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	264 Lvar1 = (UWORD32)lvar1 >> 16;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	265 Lvar2 = (UWORD32)lvar2 >> 16;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	266
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	267 temp = Lvar1 + Lvar2 + carry;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	268
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	269 carry = (UWORD32)temp >> 16;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	270
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	271 temp = (UWORD32)temp << 16;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	272
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	273 result = result \| temp;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	274
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	275 temp = guard1 + guard2 + carry;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	276
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	277 *guardout = (WORD16)temp;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	278
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	279 return( result );
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	280 }
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	281
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	282
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	283 INLINE WORD32 Mult_40b(WORD32 var1, WORD16 var2, WORD16 *guardout)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	284 {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	285 WORD32 mult,guard1guard2;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	286 WORD32 aux1;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	287 UWORD32 aux2;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	288 WORD16 neg_flag=0;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	289 WORD32 var1_low_nosign,var2_nosign;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	290
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	291 if (var2<0)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	292 {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	293 var2=-var2;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	294 neg_flag=1;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	295 }
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	296
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	297 /aux1 = AccHigh(var1)var2 */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	298 aux1 = (WORD32)(var1>>16) * (WORD32)var2;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	299 /* 16 bits * 16 bits -> 32 bits result */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	300
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	301 /aux2 = AccLow(var1)var2 (unsigned multiplication) */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	302 /* Performs the sign suppression of the words */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	303 var1_low_nosign = (UWORD16)var1;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	304 var2_nosign = (UWORD16) var2;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	305
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	306 aux2 = (UWORD32)var1_low_nosign * (UWORD32)var2_nosign;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	307
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	308 /Shift aux1=F48 of 16 bit left /
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	309 guard1guard2=aux1&0xFFFF0000L;/guard1=(WORD16)(aux1>>16)/
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	310 /guard2=0x0000 /
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	311 aux1=aux1<<16;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	312
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	313
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	314 /* ((var1_highvar2)<<16) +(var1_lowvar2) = aux1 + aux2 */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	315 /* aux1 and aux2 are both 48 bits variables */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	316 /* We first add the low pats of aux1 and aux2 and we give*/
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	317 /* a 32 bits result and a carry if needed */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	318 mult=Add_40b(guard1guard2,aux1,aux2,guardout );
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	319
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	320 if (neg_flag)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	321 {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	322 mult=-mult;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	323 if (*guardout!=0)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	324 guardout=-(guardout)-1;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	325 else
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	326 *guardout=-1;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	327 }
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	328
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	329 return(mult);
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	330 }
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	331
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	332
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	333 /***********************************************************************/
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	334 /* This function allows to multiply a WORD32 and a WORD16, both POSITIVE, */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	335 /* variables. Result is WORD32. */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	336 /***********************************************************************/
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	337 INLINE WORD32 UMult_40b(WORD32 var1, WORD16 var2, WORD16 *guardout)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	338 {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	339 WORD32 mult,guard1guard2;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	340 UWORD32 aux1,aux2;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	341 WORD32 var1_high_nosign,var1_low_nosign,var2_nosign;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	342
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	343
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	344 /aux1 = AccHigh(var1)var2 (unsigned multiplication) */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	345 /* Performs the sign suppression of the words */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	346 var1_high_nosign = (UWORD32)var1>>16;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	347 var2_nosign = (UWORD16) var2;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	348
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	349 aux1 = (UWORD32)var1_high_nosign * (UWORD32)var2_nosign;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	350
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	351 /aux2 = AccLow(var1)var2 (unsigned multiplication) */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	352 /* Performs the sign suppression of the words */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	353 var1_low_nosign = (WORD32)((UWORD16)var1);
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	354
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	355 aux2 = (UWORD32)var1_low_nosign * (UWORD32)var2_nosign;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	356
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	357 /Shift aux1=F48 of 16 bit left /
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	358 guard1guard2=aux1&0xFFFF0000L;/guard1=(WORD16)(aux1>>16)/
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	359 /guard2=0x0000 /
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	360 aux1=aux1<<16;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	361
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	362
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	363 /* ((var1_highvar2)<<16) +(var1_lowvar2) = aux1 + aux2 */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	364 mult=Add_40b(guard1guard2,aux1,aux2,guardout);
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	365
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	366 return(mult);
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	367 }
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	368
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	369
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	370 /-------------------------------------------------------/
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	371 /* l1ctl_afc() */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	372 /-------------------------------------------------------/
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	373 /* Parameters : */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	374 /* Return : */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	375 /* Functionality : */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	376 /-------------------------------------------------------/
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	377 #if (VCXO_ALGO == 0)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	378 WORD16 l1ctl_afc (UWORD8 phase, UWORD32 *frame_count, WORD16 angle, WORD32 snr, UWORD16 radio_freq)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	379 #else
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	380 WORD16 l1ctl_afc (UWORD8 phase, UWORD32 *frame_count, WORD16 angle, WORD32 snr, UWORD16 radio_freq, UWORD32 l1_mode)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	381 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	382 {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	383 /*************************/
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	384 /* Variables declaration */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	385 /*************************/
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	386 WORD16 i=0;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	387 UWORD32 denom; /* F12.20 */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	388 WORD32 var_32,num,Phi_32=0,var1,var2,guard1guard2;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	389 static UWORD32 P=C_cov_start; /* F12.20 */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	390 static WORD32 Psi=0; /* F13.19 */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	391 static WORD16 Psi_quant[C_N_del+1]; /* F13.3 */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	392 WORD16 var_16;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	393 WORD16 Phi=0; /* F1.15 */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	394 WORD16 quotient,guard1,guard2,guardout;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	395 UWORD32 LGuard;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	396 WORD16 denomH,denomH_3msb;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	397 UWORD32 K=0; /* algo 1 */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	398
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	399 static WORD16 old_Psi_quant[C_N_del+1];
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	400 static WORD32 old_Psi=0;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	401
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	402 #if (VCXO_ALGO == 1)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	403 static WORD32 psi_past[C_N_del+1]; /* F13.19 */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	404 static WORD16 psi_quant; /* F13.3 */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	405 static WORD16 quant_avg;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	406 static UWORD32 M_Count;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	407 static WORD32 psi_avg[C_PSI_AVG_SIZE_D+1]; // Data history array
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	408 static WORD16 B_Count; // Counter for consecutive SNR below C_thr_snr
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	409 #if 0 /* LoCosto added var */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	410 UWORD16 L = 10433; // Gain algo2
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	411 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	412 static UWORD16 first_avg;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	413 static UWORD16 good_snr;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	414
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	415 /* to be able to keep in memory the old AFC variables in case of spurious
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	416 FB detection */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	417 static WORD32 old_psi_past[C_N_del+1]; /* F13.19 */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	418 static WORD16 old_psi_quant; /* F13.3 */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	419
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	420 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	421 #if (L1_FF_MULTIBAND == 1)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	422 UWORD8 physical_band_id;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	423 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	424
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	425 #if 0 /* LoCosto added var init */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	426 //Set AFC close loop gain for ALGO_AFC_LQG_PREDICTOR.
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	427 if(l1_mode==I_MODE)//MS is in Idle mode
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	428 L = 41732; //F0.20 L=41732/2^20 = 0.04
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	429 else //All other modes than Idle
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	430 L = 10433; //F0.20 L=10433/2^20 = 0.01
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	431 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	432
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	433 #if (L1_FF_MULTIBAND == 0)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	434
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	435 if (((l1_config.std.id == DUAL) \|\| (l1_config.std.id == DUALEXT) \|\| (l1_config.std.id == DUAL_US)) &&
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	436 #if (VCXO_ALGO == 1)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	437 ((phase != AFC_INIT_CENTER) \|\| (phase != AFC_INIT_MIN) \|\| (phase != AFC_INIT_MAX)))
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	438 #else
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	439 (phase != AFC_INIT))
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	440 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	441 {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	442 if (radio_freq >= l1_config.std.first_radio_freq_band2)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	443 {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	444 angle = (angle + 1) >> 1;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	445 }
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	446 }
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	447
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	448 else if (((l1_config.std.id == DCS1800) \|\| (l1_config.std.id == PCS1900)) &&
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	449 #if (VCXO_ALGO == 1)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	450 ((phase != AFC_INIT_CENTER) \|\| (phase != AFC_INIT_MIN) \|\| (phase != AFC_INIT_MAX)))
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	451 #else
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	452 (phase != AFC_INIT))
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	453 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	454 {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	455 angle = (angle + 1) >> 1;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	456 }
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	457
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	458 #else // L1_FF_MULTIBAND = 1 below
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	459
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	460 #if (VCXO_ALGO == 1)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	461 if((phase != AFC_INIT_CENTER) \|\| (phase != AFC_INIT_MIN) \|\| (phase != AFC_INIT_MAX))
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	462 #else
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	463 if(phase != AFC_INIT)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	464 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	465 {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	466 physical_band_id = l1_multiband_radio_freq_convert_into_physical_band_id(radio_freq);
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	467
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	468 if( (multiband_rf[physical_band_id].gsm_band_identifier == DCS1800) \|\| (multiband_rf[physical_band_id].gsm_band_identifier == PCS1900))
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	469 {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	470 angle = (angle + 1) >> 1;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	471 }
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	472 }
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	473
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	474 #endif // #if (L1_FF_MULTIBAND == 1) else
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	475
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	476
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	477
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	478 /*********************************/
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	479 /* frequency offset compensation */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	480 /*********************************/
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	481 /* Initialization */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	482
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	483 #if (VCXO_ALGO == 1)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	484 switch (l1_config.params.afc_algo)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	485 {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	486
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	487 /* algo1 only: */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	488 case ALGO_AFC_KALMAN:
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	489 {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	490 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	491 #if (VCXO_ALGO == 0)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	492 if (phase==AFC_INIT)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	493 {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	494 // WARNING
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	495 // In this case, "angle" variable contains EEPROM_AFC initialization value
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	496 // directly loaded from EEPROM, and "snr" variable is not meaningful.
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	497 /* Static variables initialisation */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	498 P=C_cov_start;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	499 Psi=0;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	500 if (angle>C_max_step)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	501 Psi_quant[C_N_del]=C_max_step;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	502 else
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	503 if(angle<C_min_step)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	504 Psi_quant[C_N_del]=C_min_step;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	505 else Psi_quant[C_N_del]=angle;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	506
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	507 Psi=l1_config.params.psi_stPsi_quant[C_N_del]; / F0.16 * F13.3 = F13.19 */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	508 } /* end AFC_INIT*/
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	509 else
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	510 {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	511 if (phase==AFC_OPEN_LOOP)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	512 {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	513 /* delay line for Psi_quant values */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	514 for (i=1;i<=C_N_del;i++)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	515 Psi_quant[i-1]=Psi_quant[i];
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	516
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	517 var_32=(WORD32)((WORD32)angle*l1_config.params.psi_sta_inv)<<4;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	518 /(F16.0 F1.15 = F17.15) << 4 = F13.19 */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	519
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	520 #if(RF_FAM == 61)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	521 /* In order to implement the NINT function for a F16.0, we check */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	522 /* if var_32 + 0.5218 is a multiple of 218 /
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	523 quotient=(WORD16)((WORD32)(((WORD32)(var_32+(1<<17)))/(1<<18)));
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	524 var_16=quotient*4;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	525 #else
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	526 /* In order to implement the NINT function for a F16.0, we check */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	527 /* if var_32 + 0.5219 is a multiple of 219 /
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	528 quotient=(WORD16)((WORD32)(((WORD32)(var_32+(1<<18)))/(1<<19)));
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	529 var_16=quotient*8;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	530 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	531 if (var_16>C_max_step)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	532 Psi_quant[C_N_del]=Add_Sat_sign_16b(Psi_quant[C_N_del],C_max_step);
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	533 else
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	534 if(var_16<C_min_step)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	535 Psi_quant[C_N_del]=Add_Sat_sign_16b(Psi_quant[C_N_del],C_min_step);
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	536 else Psi_quant[C_N_del]=Add_Sat_sign_16b(Psi_quant[C_N_del],var_16); /* F13.3 */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	537
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	538 Psi=l1_config.params.psi_stPsi_quant[C_N_del]; / F0.16 * F13.3 = F13.19 */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	539 }/end if AFC_OPEN_LOOP/
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	540
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	541 else
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	542 {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	543 /* delay line for Psi_quant values */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	544 for (i=1;i<=C_N_del;i++)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	545 Psi_quant[i-1]=Psi_quant[i];
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	546
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	547 /********************/
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	548 /* Filter algorithm */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	549 /********************/
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	550
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	551 /* Covariance error is increased of C_Q */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	552 P=P+(frame_count)C_Q;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	553
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	554 /* Clipping of P */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	555 if (P>C_thr_P) P=C_thr_P;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	556
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	557 if (snr>=C_thr_snr)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	558 {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	559 /* Clipping of error angle */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	560 if (angle>C_thr_phi)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	561 angle=C_thr_phi;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	562 if (angle<-C_thr_phi)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	563 angle=-C_thr_phi;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	564
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	565 /* Kalman gain */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	566 /K=P(1/(P+C_a0_kalman+(C_g_kalmanRNS))) /
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	567 /C_a0_kalman=0.01 /
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	568 /C_g_kalman =0.05 /
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	569 num=(C_g_kalman/snr)+P+C_a0_kalman;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	570 /* (F2.30 / F6.10) = F 12.20 */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	571
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	572 /* denom = P << 19 = F 1.39 */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	573 /* extension of denom=P to a 40 bits variable */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	574 /* denom (F12.20) << 16 = F 4.36 */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	575 guard1=(WORD16)((WORD32)P>>16);
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	576 /* denom = P<<16 = (F4.36) << 3 = F 1.39 */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	577 denomH=(UWORD16)P;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	578 /* Low part of denom is equal to 0, because P has been 16 */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	579 /* bits left shifted previously. */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	580 denomH_3msb=(denomH>>13)&0x0007;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	581 guard1=(guard1<<3)\|denomH_3msb;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	582 denomH<<=3;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	583 denom=(UWORD32)denomH<<16;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	584 /* num + guard1 are a 40 bits representation of P */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	585 /* In order to compute P(F1.39)/num, we sample P in guard1 */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	586 /* (scaled to a 32 bits number) and num (32 bits number) */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	587 /* K = ((guard1<<24)/num)<<8 + (denom/num) */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	588 var1=(WORD32)guard1<<24;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	589 var1=var1/num;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	590 var1=(WORD32)var1<<8;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	591 /* var2 is an unsigned variable, var1 contains signed guard*/
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	592 /* bits. */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	593 var2=denom/num;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	594 K = (var1+var2)<<1; /* F1.39 / F12.20 = F13.19 */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	595 /* F13.19 << 1 = F12.20 */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	596
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	597 /* Clipping of the Kalman gain */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	598 if (K>=C_thr_K)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	599 K=C_thr_K;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	600
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	601 /*******************************************************/
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	602 /* P=(1-K)P = 0.8 0.5 at maximum */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	603 /*******************************************************/
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	604 /* Perform a positive variable F12.20 multiplication by*/
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	605 /* positive variable F12.20 */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	606 var_16=(WORD16)(1048576L-K); /* acclow(1-K) = F12.20 */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	607 guard1=0; /* positive variable */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	608 var1=UMult_40b(P,var_16,&guard1);
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	609 var_16=(WORD16)((1048576L-K)>>16);
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	610 /* acchigh(1-K) = F12.20 */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	611 var2=Pvar_16; / var2 = 0x80000 * 0xc */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	612 /* at maximum, so result */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	613 /* is 32 bits WORD32 and */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	614 /* equal 0x600000 */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	615 /* extension of var2 to a 40 bits variable : var2<<16 */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	616 guard2=(WORD16)((WORD32)var2>>16);
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	617 guard1guard2=((WORD32)guard1<<16) \|((WORD32) guard2&0x0000FFFFL);
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	618 var2=var2<<16;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	619 var_32=Add_40b(guard1guard2,var1,var2,&guardout);
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	620 /* var_32 (F8.40) >> 16 = F8.24 */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	621 LGuard=(WORD32)guardout<<16;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	622 var1=(UWORD32)var_32>>16;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	623 /* var_32 >> 4 = F12.20 */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	624 P=(var1+LGuard)>>4;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	625
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	626 Phi_32=Mult_40b(l1_config.params.psi_st_32,Psi_quant[0],&guardout);
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	627 /* F0.32 * F13.3 = F5.35 */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	628 LGuard=(WORD32)guardout<<16; /* var_32 (F5.35) >> 16 */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	629 /* F13.19 */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	630 var1=(UWORD32)Phi_32>>16;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	631 Phi_32=Psi-(LGuard+var1); /* F13.19 */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	632
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	633 /Phi=angle-Phi_32/
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	634 Phi_32=((WORD32)angle<<4)-Phi_32;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	635 /* F1.15 * 4 = F13.19 */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	636 Phi=(WORD16)(Phi_32>>4); /* F17.15 */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	637 /var1=KPhi F12.20 * F1.15 = 13.35 */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	638 guard1=0;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	639 var1=Mult_40b(K,Phi,&guard1);
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	640 /* var1 (F13.35) >> 16 */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	641 /* F13.19 */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	642 LGuard=(WORD32)guard1<<16;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	643 var1=(UWORD32)var1>>16;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	644 Psi+=var1+LGuard;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	645 }/if snr /
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	646
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	647 var_32=Mult_40b(Psi,l1_config.params.psi_st_inv,&guardout);
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	648 /* F13.19 * C = F13.19 */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	649
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	650 #if(RF_FAM == 61)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	651 /* In order to implement the NINT function for a F13.3, we check */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	652 /* if var_32 + 0.5218 is a multiple of 218 /
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	653 quotient=(WORD16)((WORD32)(((WORD32)(var_32+(1<<17)))/(1<<18)));
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	654 var_16=quotient*4;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	655 #else
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	656 /* In order to implement the NINT function for a F13.3, we check */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	657 /* if var_32 + 0.5219 is a multiple of 219 /
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	658 quotient=(WORD16)((WORD32)(((WORD32)(var_32+(1<<18)))/(1<<19)));
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	659 var_16=quotient*8;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	660 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	661 if (var_16>C_max_step)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	662 Psi_quant[C_N_del]=C_max_step;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	663 else
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	664 if(var_16<C_min_step)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	665 Psi_quant[C_N_del]=C_min_step;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	666 else Psi_quant[C_N_del]=var_16; /* F13.3 */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	667
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	668 }/end AFC_CLOSE_LOOP/
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	669 } /* end else AFC_INIT*/
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	670
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	671 *frame_count=0;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	672 return(Psi_quant[C_N_del]>>3); /* F16.0 */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	673
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	674 #else
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	675
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	676 } /* end case algo 1 */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	677
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	678
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	679 /* algo2 + init + estimator/predictor */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	680 case ALGO_AFC_LQG_PREDICTOR:
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	681 {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	682 /******************************************************************/
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	683 /* (New) VCXO Algorithm */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	684 /******************************************************************/
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	685
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	686 switch (phase) {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	687 case AFC_INIT_CENTER :
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	688 case AFC_INIT_MAX :
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	689 case AFC_INIT_MIN :
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	690 quant_avg = 0;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	691 M_Count = 0;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	692 #if 0 /* present in LoCosto but not in TCS211 */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	693 for (i = 0; i <= C_PSI_AVG_SIZE_D ; i++) //omaps00090550
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	694 psi_avg[i] = 0;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	695 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	696 first_avg = 1;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	697 good_snr = 0;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	698
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	699 // DAC search algorithm is as follows - up to 12 attempts are made
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	700 // DAC search algorithm uses three values : DAC_center -> DAC_max -> DAC_min ->
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	701 // The first four attempts are made on DAC_center
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	702 // The next four attempts are made on DAC_max
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	703 // The last four attempts are made on DAC_min
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	704 // There are statistical reasons for trying four times
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	705
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	706 switch (phase)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	707 {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	708 case AFC_INIT_CENTER:
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	709 psi_quant = l1_config.params.afc_dac_center;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	710 break;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	711 case AFC_INIT_MAX:
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	712 psi_quant = l1_config.params.afc_dac_max;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	713 break;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	714 case AFC_INIT_MIN:
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	715 psi_quant = l1_config.params.afc_dac_min;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	716 break;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	717 default :
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	718 break;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	719 }
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	720
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	721 /* F0.32 * F13.3 = F5.35 */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	722 psi_past[C_N_del]=Mult_40b(l1_config.params.psi_st_32,psi_quant, &guardout);
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	723 /* (F13.3<<16 )+(F5.35>>16) = F13.19 */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	724 psi_past[C_N_del]=((WORD32)guardout<<16)+((UWORD32)psi_past[C_N_del]>>16);
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	725
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	726 break;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	727
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	728 case AFC_OPEN_LOOP :
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	729 {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	730 /* VCXO changes for spurious FB detection */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	731 if (l1s.spurious_fb_detected == TRUE)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	732 {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	733 psi_quant = old_psi_quant;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	734
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	735 for(i=0;i<C_N_del+1;i++)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	736 psi_past[i] = old_psi_past[i];
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	737
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	738 /* reset the spurious_fb_detected_flag */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	739 l1s.spurious_fb_detected = FALSE;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	740 } /* end of spuriousFB detected */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	741
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	742 /* save in memory the old AFC related values */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	743 old_psi_quant = psi_quant;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	744
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	745 for(i=0;i<C_N_del+1;i++)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	746 old_psi_past[i] = psi_past[i];
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	747
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	748 /* delay line for psi_quant values */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	749 for (i = 1; i <= C_N_del; i++)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	750 psi_past[i-1] = psi_past[i];
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	751
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	752 /* (F16.0 * F1.15 = F17.15) << 4 = F13.19 */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	753 var_32 = (WORD32) ((WORD32)angle * l1_config.params.psi_sta_inv) << 4;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	754
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	755 #if(RF_FAM == 61)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	756 /* In order to implement the NINT function for a F16.0,*/
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	757 /we check if var_32 + 0.5218 is a multiple of 218 */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	758 var_16 = (WORD16)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	759 ((WORD32) (((WORD32)(var_32 + (1<<17))) / (1<<18)));
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	760 var_16 = var_16 * 4;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	761 #else
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	762 /* In order to implement the NINT function for a F16.0,*/
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	763 /we check if var_32 + 0.5219 is a multiple of 219 */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	764 var_16 = (WORD16)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	765 ((WORD32) (((WORD32)(var_32 + (1<<18))) / (1<<19)));
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	766 var_16 = var_16 * 8;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	767 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	768
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	769 #if 0 /* LoCosto code with saturation */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	770 if (var_16 > C_max_step)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	771 psi_quant = Add_Sat_sign_16b(psi_quant,C_max_step);
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	772 else if (var_16 < C_min_step)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	773 psi_quant = Add_Sat_sign_16b(psi_quant,C_min_step);
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	774 else psi_quant = Add_Sat_sign_16b(psi_quant,var_16); /* F13.3 */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	775 #else /* matching TCS211 */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	776 if (var_16 > C_max_step)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	777 psi_quant += C_max_step;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	778 else if (var_16 < C_min_step)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	779 psi_quant += C_min_step;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	780 else psi_quant += var_16; /* F13.3 */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	781 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	782
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	783 /* F0.32 * F13.3 = F5.35 */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	784 psi_past[C_N_del]=Mult_40b(l1_config.params.psi_st_32,psi_quant, &guardout);
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	785 /* (F13.3<<16 )+(F5.35>>16) = F13.19 */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	786 psi_past[C_N_del]=((WORD32)guardout<<16)+((UWORD32)psi_past[C_N_del]>>16);
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	787
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	788 }
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	789 break;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	790
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	791 case AFC_CLOSED_LOOP :
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	792
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	793 /* delay line for psi_quant values */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	794 for (i = 1; i <= C_N_del; i++)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	795 psi_past[i-1] = psi_past[i];
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	796
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	797 /************************************/
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	798 /* Estimation */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	799 /************************************/
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	800 if ( (l1_config.params.rgap_algo != 0) &&
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	801 ((l1_mode==CON_EST_MODE2)\|\|(l1_mode==DEDIC_MODE)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	802 #if L1_GPRS
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	803 \|\| l1_mode==PACKET_TRANSFER_MODE
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	804 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	805 ))
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	806 {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	807
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	808 M_Count += *frame_count;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	809 if (snr >= l1_config.params.afc_snr_thr) {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	810 // Accumulate average over N TDMA frames
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	811 psi_avg[0] += psi_past[C_N_del];
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	812 // Count number of good snr's within window_avg_size chunks
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	813 good_snr++;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	814 }
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	815 // M_Count >= M ?
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	816 if (M_Count >= l1_config.params.afc_win_avg_size_M) {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	817 // M_Count counts how far we have reached in the window_avg_size blocks
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	818
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	819 // Scale estimate relative to good snr - Don't divide by zero in case of bad measurements
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	820 if (good_snr > 0)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	821 psi_avg[0] /= good_snr;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	822
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	823 // We now have an estimation over window_avg_size TDMA frames in psi_avg[0]
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	824 if (first_avg == 1) {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	825 first_avg = 0;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	826 // Use first estimation as best guess for the other avg values
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	827 // This is used both at initialisation and when returning from reception gap
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	828 for (i = 1; i <= C_PSI_AVG_SIZE_D ; i++)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	829 psi_avg[i] = psi_avg[0];
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	830 }
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	831
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	832 // Estimation 1st order
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	833 // Use biggest window to reduce noise effects signal in psi values
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	834 // NOTE: Due to performance issues division by MSIZE is in predictor
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	835 if (l1_config.params.rgap_algo >= 1) {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	836 quant_avg = (WORD16) (psi_avg[0] - psi_avg[C_PSI_AVG_SIZE_D]);
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	837 }
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	838
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	839 for (i = C_PSI_AVG_SIZE_D - 1; i >= 0 ; i--)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	840 psi_avg[i+1] = psi_avg[i];
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	841 psi_avg[0] = 0;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	842 M_Count = 0;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	843 good_snr = 0;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	844 }
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	845
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	846 } else {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	847 // No estmation when in Idle mode (DEEP or BIG SLEEP) => Reset!
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	848 first_avg = 1;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	849 M_Count = 0;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	850 good_snr = 0;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	851 psi_avg[0] = 0;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	852 }
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	853
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	854 if (snr >= l1_config.params.afc_snr_thr) {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	855 /********************/
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	856 /* Filter algorithm */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	857 /********************/
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	858
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	859 /* No prediction during normal operation */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	860 B_Count= 0;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	861
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	862 /* Clip error angle */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	863 if (angle > C_thr_phi)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	864 angle = C_thr_phi;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	865 if (angle < -C_thr_phi)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	866 angle = -C_thr_phi;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	867
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	868 Phi_32 = psi_past[C_N_del] - psi_past[0]; /* F13.19 */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	869 /* Phi = angle - Phi_32*/
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	870 Phi_32 = ((WORD32) angle << 4) - Phi_32;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	871 /* F1.15 * 4 = F13.19 */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	872 #if 0 /* LoCosto code */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	873 Phi = (WORD16)((WORD32)((WORD32)(Phi_32 + (1<<3)))/ (1<<4)); /* F17.15 */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	874 #else /* TCS211 reconstruction */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	875 Phi = Phi_32 >> 4;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	876 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	877 /* (F0.20 * F1.15) >> 16 = F13.19 */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	878 #if 0 /* LoCosto code with saturation and L */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	879 var_32 = (L * Phi + (1<<15)) >> 16;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	880 psi_past[C_N_del] = Add_Sat_sign_32b(psi_past[C_N_del],var_32);
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	881 #else /* matching TCS211 */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	882 psi_past[C_N_del] += (10433 * Phi) >> 16;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	883 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	884
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	885 }
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	886 else
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	887 {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	888 /************************************/
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	889 /* Prediction */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	890 /************************************/
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	891
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	892 // Only predict in dedicated mode
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	893 // NO prediction in idle mode
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	894 // l1a_l1s_com.dedic_set.SignalCode = NULL
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	895 if ( (l1_config.params.rgap_algo != 0) &&
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	896 ((l1_mode==CON_EST_MODE2)\|\|(l1_mode==DEDIC_MODE)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	897 #if L1_GPRS
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	898 \|\| l1_mode==PACKET_TRANSFER_MODE
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	899 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	900 ))
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	901 {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	902 /* Prediction of psi during reception gaps */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	903 B_Count
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	904 += *frame_count;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	905
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	906 /* Predict psi ONLY when we have sufficient measurements available */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	907 /* If we don't have enough measurements we don't do anything (= 0th order estimation)*/
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	908
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	909 // Was the consecutive bad SNRs threshold value exceeded?
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	910 if (B_Count>= l1_config.params.rgap_bad_snr_count_B) {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	911
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	912 // Predict with 0th order estimation is the default
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	913
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	914 // Predict with 1st order estimation
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	915 if (l1_config.params.rgap_algo >= 1)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	916 {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	917 #if 0 /* LoCosto code with saturation */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	918 psi_past[C_N_del] = Add_Sat_sign_32b(psi_past[C_N_del],
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	919 ((quant_avg * (l1_config.params.rgap_bad_snr_count_B))/(C_MSIZE))
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	920 );
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	921 #else /* matching TCS211 */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	922 psi_past[C_N_del] +=
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	923 ((quant_avg * (l1_config.params.rgap_bad_snr_count_B))/(C_MSIZE));
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	924 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	925 }
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	926
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	927 B_Count= B_Count - l1_config.params.rgap_bad_snr_count_B;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	928
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	929 // Indicate by raising first_avg flag that a reception gap has occurred
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	930 // I.e. the psi_avg table must be reinitialised after leaving reception gap
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	931 first_avg = 1;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	932
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	933 // Counters in estimation part must also be reset
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	934 M_Count = 0;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	935 good_snr = 0;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	936 psi_avg[0] = 0;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	937 }
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	938 }
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	939 }
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	940
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	941 /* Quantize psi value */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	942
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	943 /* F0.19 * 16.0 = F16.19 */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	944 #if 0 /* LoCosto code */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	945 var_32 = Sat_Mult_20sign_16unsign(psi_past[C_N_del],l1_config.params.psi_st_inv);
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	946 #else /* TCS211 reconstruction */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	947 var_32 = psi_past[C_N_del] * l1_config.params.psi_st_inv;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	948 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	949
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	950 #if(RF_FAM == 61)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	951 /* In order to implement the NINT function for a F13.3,*/
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	952 /we check if var_32 + 0.5218 is a multiple of 218 */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	953 var_16 = (WORD16)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	954 ((WORD32)((WORD32)(var_32 + (1<<17))) / (1<<18));
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	955 var_16 = var_16 * 4;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	956 #else
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	957 /* In order to implement the NINT function for a F13.3,*/
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	958 /we check if var_32 + 0.5219 is a multiple of 219 */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	959 var_16 = (WORD16)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	960 ((WORD32)((WORD32)(var_32 + (1<<18))) / (1<<19));
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	961 var_16 = var_16 * 8;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	962 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	963 if (var_16 > C_max_step)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	964 psi_quant = C_max_step;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	965 else if (var_16 < C_min_step)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	966 psi_quant = C_min_step;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	967 else
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	968 psi_quant = var_16; /* F13.3 */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	969 break;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	970 } // switch phase
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	971
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	972 *frame_count = 0;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	973
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	974 return (psi_quant >> 3); /* F16.0 */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	975 } /* end case algo 2 */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	976
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	977 /* algo1 + init + estimator/predictor */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	978 case ALGO_AFC_KALMAN_PREDICTOR:
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	979 {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	980 if ((phase==AFC_INIT_CENTER) \|\| (phase==AFC_INIT_MAX) \|\| (phase==AFC_INIT_MIN))
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	981 {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	982 // WARNING
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	983 // In this case, "angle" variable contains EEPROM_AFC initialization value
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	984 // directly loaded from EEPROM, and "snr" variable is not meaningful.
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	985 /* Static variables initialisation */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	986
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	987 quant_avg = 0;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	988 M_Count = 0;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	989 #if 0 /* present in LoCosto but not in TCS211 */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	990 for (i = 0; i <=C_PSI_AVG_SIZE_D ; i++) //omaps00090550
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	991 psi_avg[i] = 0;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	992 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	993 first_avg = 1;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	994 good_snr = 0;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	995
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	996 // DAC search algorithm is as follows - up to 12 attempts are made
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	997 // DAC search algorithm uses three values : DAC_center -> DAC_max -> DAC_min ->
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	998 // The first four attempts are made on DAC_center
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	999 // The next four attempts are made on DAC_max
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1000 // The last four attempts are made on DAC_min
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1001 // There are statistical reasons for trying four times
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1002
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1003 switch (phase) {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1004 case AFC_INIT_CENTER:
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1005 Psi_quant[C_N_del] = l1_config.params.afc_dac_center;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1006 break;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1007 case AFC_INIT_MAX:
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1008 Psi_quant[C_N_del] = l1_config.params.afc_dac_max;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1009 break;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1010 case AFC_INIT_MIN:
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1011 Psi_quant[C_N_del] = l1_config.params.afc_dac_min;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1012 break;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1013 default :
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1014 break;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1015 }
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1016
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1017 P=C_cov_start;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1018 Psi=0;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1019 if (angle>C_max_step)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1020 Psi_quant[C_N_del]=C_max_step;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1021 else
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1022 if(angle<C_min_step)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1023 Psi_quant[C_N_del]=C_min_step;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1024 else Psi_quant[C_N_del]=angle;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1025
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1026 /* F0.32 * F13.3 = F5.35 */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1027 Psi=Mult_40b(l1_config.params.psi_st_32,Psi_quant[C_N_del], &guardout);
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1028 /* (F13.3<<16 )+(F5.35>>16) = F13.19 */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1029 Psi=((WORD32)guardout<<16)+((UWORD32)Psi>>16);
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1030
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1031 } /* end AFC_INIT*/
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1032 else
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1033 {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1034 if (phase==AFC_OPEN_LOOP)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1035 {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1036 /* relaod last good values in the ALGO */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1037 if (l1s.spurious_fb_detected == TRUE)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1038 {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1039 for(i=0;i<C_N_del+1;i++)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1040 Psi_quant[i] = old_Psi_quant[i];
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1041
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1042 Psi = old_Psi;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1043 l1s.spurious_fb_detected = FALSE;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1044 }
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1045
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1046 /* Save the old values in memory */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1047 for(i=0;i<C_N_del+1;i++)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1048 old_Psi_quant[i] = Psi_quant[i];
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1049 old_Psi = Psi;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1050
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1051 /* delay line for Psi_quant values */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1052 for (i=1;i<=C_N_del;i++)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1053 Psi_quant[i-1]=Psi_quant[i];
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1054
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1055 var_32=(WORD32)((WORD32)angle*l1_config.params.psi_sta_inv)<<4;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1056 /(F16.0 F1.15 = F17.15) << 4 = F13.19 */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1057
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1058 #if(RF_FAM == 61)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1059 /* In order to implement the NINT function for a F16.0, we check */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1060 /* if var_32 + 0.5218 is a multiple of 218 /
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1061 quotient=(WORD16)((WORD32)(((WORD32)(var_32+(1<<17)))/(1<<18)));
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1062 var_16=quotient*4;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1063 #else
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1064 /* In order to implement the NINT function for a F16.0, we check */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1065 /* if var_32 + 0.5219 is a multiple of 219 /
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1066 quotient=(WORD16)((WORD32)(((WORD32)(var_32+(1<<18)))/(1<<19)));
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1067 var_16=quotient*8;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1068 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1069
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1070 #if 0 /* LoCosto code with saturation */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1071 if (var_16>C_max_step)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1072 Psi_quant[C_N_del]=Add_Sat_sign_16b(Psi_quant[C_N_del],C_max_step);
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1073 else if (var_16<C_min_step)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1074 Psi_quant[C_N_del]=Add_Sat_sign_16b(Psi_quant[C_N_del],C_min_step);
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1075 else Psi_quant[C_N_del]=Add_Sat_sign_16b(Psi_quant[C_N_del],var_16); /* F13.3 */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1076 #else /* matching TCS211 */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1077 if (var_16>C_max_step)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1078 Psi_quant[C_N_del] += C_max_step;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1079 else if (var_16<C_min_step)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1080 Psi_quant[C_N_del] += C_min_step;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1081 else Psi_quant[C_N_del] += var_16; /* F13.3 */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1082 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1083
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1084 /* F0.32 * F13.3 = F5.35 */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1085 Psi=Mult_40b(l1_config.params.psi_st_32,Psi_quant[C_N_del], &guardout);
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1086 /* (F13.3<<16 )+(F5.35>>16) = F13.19 */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1087 Psi=((WORD32)guardout<<16)+((UWORD32)Psi>>16);
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1088
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1089 }/end if AFC_OPEN_LOOP/
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1090 else
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1091 {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1092
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1093 /* delay line for Psi_quant values */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1094 for (i=1;i<=C_N_del;i++)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1095 Psi_quant[i-1]=Psi_quant[i];
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1096
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1097 /************************************/
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1098 /* Estimation */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1099 /************************************/
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1100 if ( (l1_config.params.rgap_algo != 0) &&
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1101 ((l1_mode==CON_EST_MODE2)\|\|(l1_mode==DEDIC_MODE)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1102 #if L1_GPRS
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1103 \|\| l1_mode==PACKET_TRANSFER_MODE
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1104 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1105 ))
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1106 {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1107
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1108 M_Count += *frame_count;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1109 if (snr >= l1_config.params.afc_snr_thr) {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1110 // Accumulate average over N TDMA frames
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1111 psi_avg[0] += psi_past[C_N_del];
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1112 // Count number of good snr's within window_avg_size chunks
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1113 good_snr++;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1114 }
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1115
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1116 // M_Count >= M ?
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1117 if (M_Count >= l1_config.params.afc_win_avg_size_M) {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1118 // M_Count counts how far we have reached in the window_avg_size blocks
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1119
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1120 // Scale estimate relative to good snr - Don't divide by zero in case of bad measurements
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1121 if (good_snr > 0)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1122 psi_avg[0] /= good_snr;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1123
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1124 // We now have an estimation over window_avg_size TDMA frames in psi_avg[0]
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1125 if (first_avg == 1) {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1126 first_avg = 0;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1127 // Use first estimation as best guess for the other avg values
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1128 // This is used both at initialisation and when returning from reception gap
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1129 for (i = 1; i <= C_PSI_AVG_SIZE_D ; i++)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1130 psi_avg[i] = psi_avg[0];
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1131 }
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1132
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1133 // Estimation 1st order
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1134 // Use biggest window to reduce noise effects signal in psi values
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1135 // NOTE: Due to performance issues division by MSIZE is in predictor
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1136 if (l1_config.params.rgap_algo >= 1) {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1137 quant_avg = (WORD16) (psi_avg[0] - psi_avg[C_PSI_AVG_SIZE_D]);
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1138 }
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1139
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1140 for (i = C_PSI_AVG_SIZE_D - 1; i >= 0 ; i--)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1141 psi_avg[i+1] = psi_avg[i];
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1142 psi_avg[0] = 0;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1143 M_Count = 0;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1144 good_snr = 0;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1145 }
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1146
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1147 } else {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1148 // No estmation when in Idle mode (DEEP or BIG SLEEP) => Reset!
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1149 first_avg = 1;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1150 M_Count = 0;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1151 good_snr = 0;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1152 psi_avg[0] = 0;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1153 }
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1154
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1155 /********************/
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1156 /* Filter algorithm */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1157 /********************/
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1158
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1159 /* Covariance error is increased of C_Q */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1160 P=P+(frame_count)C_Q;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1161
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1162 /* Clipping of P */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1163 if (P>C_thr_P) P=C_thr_P;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1164
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1165 if (snr>=C_thr_snr)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1166 {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1167 /* Clipping of error angle */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1168 if (angle>C_thr_phi)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1169 angle=C_thr_phi;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1170 if (angle<-C_thr_phi)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1171 angle=-C_thr_phi;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1172
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1173 /* Kalman gain */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1174 /K=P(1/(P+C_a0_kalman+(C_g_kalmanRNS))) /
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1175 /C_a0_kalman=0.01 /
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1176 /C_g_kalman =0.05 /
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1177 num=(C_g_kalman/snr)+P+C_a0_kalman;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1178 /* (F2.30 / F6.10) = F 12.20 */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1179
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1180 /* denom = P << 19 = F 1.39 */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1181 /* extension of denom=P to a 40 bits variable */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1182 /* denom (F12.20) << 16 = F 4.36 */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1183 guard1=(WORD16)((WORD32)P>>16);
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1184 /* denom = P<<16 = (F4.36) << 3 = F 1.39 */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1185 denomH=(UWORD16)P;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1186 /* Low part of denom is equal to 0, because P has been 16 */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1187 /* bits left shifted previously. */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1188 denomH_3msb=(denomH>>13)&0x0007;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1189 guard1=(guard1<<3)\|denomH_3msb;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1190 denomH<<=3;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1191 denom=denomH<<16; //(UWORD32) removed typecast omaps00090550
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1192 /* num + guard1 are a 40 bits representation of P */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1193 /* In order to compute P(F1.39)/num, we sample P in guard1 */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1194 /* (scaled to a 32 bits number) and num (32 bits number) */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1195 /* K = ((guard1<<24)/num)<<8 + (denom/num) */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1196 var1=(WORD32)guard1<<24;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1197 var1=var1/num;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1198 var1=(WORD32)var1<<8;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1199 /* var2 is an unsigned variable, var1 contains signed guard*/
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1200 /* bits. */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1201 #if 0 /* fixed LoCosto code */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1202 var2= ((WORD32)(denom)/(num)); //omaps00090550
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1203 #else /* matching TCS211 */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1204 var2= denom / num;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1205 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1206 K = (var1+var2)<<1; /* F1.39 / F12.20 = F13.19 */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1207 /* F13.19 << 1 = F12.20 */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1208
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1209 /* Clipping of the Kalman gain */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1210 if (K>=C_thr_K)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1211 K=C_thr_K;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1212
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1213 /*******************************************************/
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1214 /* P=(1-K)P = 0.8 0.5 at maximum */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1215 /*******************************************************/
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1216 /* Perform a positive variable F12.20 multiplication by*/
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1217 /* positive variable F12.20 */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1218 var_16=(WORD16)(1048576L-K); /* acclow(1-K) = F12.20 */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1219 guard1=0; /* positive variable */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1220 var1=UMult_40b(P,var_16,&guard1);
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1221 var_16=(WORD16)((1048576L-K)>>16);
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1222 /* acchigh(1-K) = F12.20 */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1223 var2=Pvar_16; / var2 = 0x80000 * 0xc */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1224 /* at maximum, so result */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1225 /* is 32 bits WORD32 and */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1226 /* equal 0x600000 */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1227 /* extension of var2 to a 40 bits variable : var2<<16 */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1228 guard2=(WORD16)((WORD32)var2>>16);
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1229 guard1guard2=((WORD32)guard1<<16) \|((WORD32) guard2&0x0000FFFFL);
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1230 var2=var2<<16;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1231 var_32=Add_40b(guard1guard2,var1,var2,&guardout);
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1232 /* var_32 (F8.40) >> 16 = F8.24 */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1233 LGuard=(WORD32)guardout<<16;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1234 var1=(UWORD32)var_32>>16;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1235 /* var_32 >> 4 = F12.20 */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1236 P=(var1+LGuard)>>4;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1237
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1238 Phi_32=Mult_40b(l1_config.params.psi_st_32,Psi_quant[0],&guardout);
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1239 /* F0.32 * F13.3 = F5.35 */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1240 LGuard=(WORD32)guardout<<16; /* var_32 (F5.35) >> 16 */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1241 /* F13.19 */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1242 var1=(UWORD32)Phi_32>>16;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1243 Phi_32=Psi-(LGuard+var1); /* F13.19 */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1244
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1245 /Phi=angle-Phi_32/
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1246 Phi_32=((WORD32)angle<<4)-Phi_32;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1247 /* F1.15 * 4 = F13.19 */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1248 Phi=(WORD16)(Phi_32>>4); /* F17.15 */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1249 /var1=KPhi F12.20 * F1.15 = 13.35 */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1250 guard1=0;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1251 var1=Mult_40b(K,Phi,&guard1);
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1252 /* var1 (F13.35) >> 16 */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1253 /* F13.19 */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1254 LGuard=(WORD32)guard1<<16;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1255 var1=(UWORD32)var1>>16;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1256 Psi+=var1+LGuard;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1257 } else {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1258 /************************************/
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1259 /* Prediction */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1260 /************************************/
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1261
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1262 // Only predict in dedicated mode
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1263 // NO prediction in idle mode
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1264 // l1a_l1s_com.dedic_set.SignalCode = NULL
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1265 if ( (l1_config.params.rgap_algo != 0) &&
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1266 ((l1_mode==CON_EST_MODE2)\|\|(l1_mode==DEDIC_MODE)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1267 #if L1_GPRS
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1268 \|\| l1_mode==PACKET_TRANSFER_MODE
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1269 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1270 ))
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1271 {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1272
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1273 /* Prediction of psi during reception gaps */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1274 B_Count+= *frame_count;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1275
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1276 /* Predict psi ONLY when we have sufficient measurements available */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1277 /* If we don't have enough measurements we don't do anything (= 0th order estimation)*/
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1278
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1279 // Was the consecutive bad SNRs threshold value exceeded?
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1280 if (B_Count>= l1_config.params.rgap_bad_snr_count_B) {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1281
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1282 // Predict with 0th order estimation is the default
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1283
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1284 // Predict with 1st order estimation
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1285 if (l1_config.params.rgap_algo >= 1)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1286 Psi += ((quant_avg * (l1_config.params.rgap_bad_snr_count_B))/(C_MSIZE));
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1287
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1288 B_Count= B_Count - l1_config.params.rgap_bad_snr_count_B;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1289
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1290 // Indicate by raising first_avg flag that a reception gap has occurred
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1291 // I.e. the psi_avg table must be reinitialised after leaving reception gap
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1292 first_avg = 1;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1293
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1294 // Counters in estimation part must also be reset
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1295 M_Count = 0;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1296 good_snr = 0;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1297 psi_avg[0] = 0;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1298 }
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1299 }
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1300 }
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1301
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1302 /* Quantize psi value */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1303
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1304 var_32=Mult_40b(Psi,l1_config.params.psi_st_inv,&guardout);
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1305 /* F13.19 * C = F13.19 */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1306
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1307 #if(RF_FAM == 61)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1308 /* In order to implement the NINT function for a F13.3, we check */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1309 /* if var_32 + 0.5218 is a multiple of 218 /
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1310 quotient=(WORD16)((WORD32)(((WORD32)(var_32+(1<<17)))/(1<<18)));
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1311 var_16=quotient*4;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1312 #else
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1313 /* In order to implement the NINT function for a F13.3, we check */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1314 /* if var_32 + 0.5219 is a multiple of 219 /
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1315 quotient=(WORD16)((WORD32)(((WORD32)(var_32+(1<<18)))/(1<<19)));
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1316 var_16=quotient*8;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1317 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1318 if (var_16>C_max_step)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1319 Psi_quant[C_N_del]=C_max_step;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1320 else
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1321 if(var_16<C_min_step)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1322 Psi_quant[C_N_del]=C_min_step;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1323 else Psi_quant[C_N_del]=var_16; /* F13.3 */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1324
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1325
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1326 }/end AFC_CLOSE_LOOP/
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1327 } /* end else AFC_INIT*/
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1328
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1329 *frame_count = 0;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1330 return(Psi_quant[C_N_del]>>3); /* F16.0 */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1331 } /* end case algo 3 */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1332 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1333
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1334 #if (VCXO_ALGO == 1)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1335 default:
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1336 return 0;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1337 //omaps00090550 break;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1338 } // end of Switch
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1339 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1340
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1341 } /* end l1ctl_afc */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1342
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1343
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1344 /************************************/
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1345 /* Automatic timing control (TOA) */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1346 /************************************/
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1347
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1348 #if (TOA_ALGO == 2)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1349
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1350 #define TOA_DEBUG_ENABLE 0
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1351
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1352
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1353 #if (TOA_DEBUG_ENABLE == 1)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1354
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1355 #define TOA_MAKE_ZERO 0
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1356
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1357 #define TOA_LOG_BUFFER_LENGTH 4096
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1358
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1359 typedef struct
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1360 {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1361 UWORD16 SNR_val;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1362 UWORD16 TOA_val;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1363 UWORD16 l1_mode;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1364 UWORD16 toa_frames_counter;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1365 UWORD16 fn_mod42432;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1366 }T_TOA_log_debug;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1367
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1368
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1369 T_TOA_log_debug toa_log_debug[TOA_LOG_BUFFER_LENGTH];
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1370 UWORD32 toa_log_index;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1371
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1372 UWORD32 toa_make_zero_f;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1373
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1374 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1375
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1376 /-------------------------------------------------------/
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1377 /* l1ctl_toa() */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1378 /-------------------------------------------------------/
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1379 /* Parameters : */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1380 /* Return : */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1381 /* Functionality : */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1382 /-------------------------------------------------------/
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1383
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1384 WORD16 l1ctl_toa (UWORD8 phase, UWORD32 l1_mode, UWORD16 SNR_val, UWORD16 TOA_val)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1385 {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1386 WORD16 TOA_period_len = TOA_PERIOD_LEN [l1_mode];
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1387 WORD16 TOA_SHIFT=ISH_INVALID;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1388 UWORD16 cumul_abs;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1389 WORD16 cumul_sign;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1390 WORD32 prod_tmp, div_tmp,prod_sign;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1391 WORD32 toa_update_flag=0;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1392 WORD16 cumul;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1393 UWORD16 cumul_counter;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1394 #if (NEW_TOA_ALGO == 1)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1395 UWORD16 Trans_active;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1396 static WORD16 cumul_noTrans =0;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1397 static UWORD16 period_counter_noTrans =0;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1398
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1399 if ((l1_mode==CON_EST_MODE2)\|\|(l1_mode==DEDIC_MODE)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1400 #if L1_GPRS
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1401 \|\| l1_mode==PACKET_TRANSFER_MODE
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1402 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1403 )
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1404 Trans_active=TRUE;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1405 else Trans_active=FALSE;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1406 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1407 if (phase==TOA_INIT)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1408 {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1409 #if (NEW_TOA_ALGO == 1)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1410 cumul_noTrans =0;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1411 period_counter_noTrans =0;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1412 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1413
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1414 l1s.toa_var.toa_frames_counter=0;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1415 l1s.toa_var.toa_accumul_counter=0;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1416 l1s.toa_var.toa_accumul_value=0;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1417 #if (TOA_DEBUG_ENABLE == 1)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1418 toa_log_index = 0;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1419 #if (TOA_MAKE_ZERO == 1)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1420 toa_make_zero_f = 1;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1421 #else
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1422 toa_make_zero_f = 0;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1423 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1424 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1425
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1426 return (TOA_SHIFT);
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1427 }
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1428
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1429 cumul = l1s.toa_var.toa_accumul_value;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1430 cumul_counter = l1s.toa_var.toa_accumul_counter;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1431
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1432 #if (TOA_DEBUG_ENABLE == 1)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1433 toa_log_debug[toa_log_index].SNR_val = SNR_val;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1434 toa_log_debug[toa_log_index].TOA_val = TOA_val;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1435 toa_log_debug[toa_log_index].l1_mode = l1_mode;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1436 toa_log_debug[toa_log_index].toa_frames_counter = l1s.toa_var.toa_frames_counter;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1437 toa_log_debug[toa_log_index].fn_mod42432 = l1s.actual_time.fn_mod42432;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1438
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1439 toa_log_index++;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1440 if(toa_log_index == TOA_LOG_BUFFER_LENGTH)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1441 {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1442 toa_log_index = 0;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1443 }
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1444 #endif /* #if (TOA_DEBUG_ENABLE == 1) */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1445
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1446 #if (TRACE_TYPE == 5)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1447 trace_toa_sim_ctrl(SNR_val, TOA_val, l1_mode, l1s.toa_var.toa_frames_counter,
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1448 l1s.toa_var.toa_accumul_counter, l1s.toa_var.toa_accumul_value);
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1449 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1450
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1451 l1s.toa_var.toa_frames_counter++;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1452
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1453 {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1454 /* Fix for TOA */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1455 #define DSP_CALC_NO_TABS_HO 0x3CA4
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1456
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1457 UWORD16 *toa_ho_fix;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1458 toa_ho_fix=(UWORD16 *)API_address_dsp2mcu(DSP_CALC_NO_TABS_HO);
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1459
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1460 if ((TOA_val >= 22) \|\| (TOA_val <= 6)) {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1461 *toa_ho_fix = 1;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1462 }
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1463
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1464 if (*toa_ho_fix == 1) {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1465 if((TOA_val <= 18) && (TOA_val >= 10)) {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1466 *toa_ho_fix = 0;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1467 }
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1468 } else {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1469 *toa_ho_fix = 0;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1470 }
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1471 }
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1472
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1473
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1474 #if (NEW_TOA_ALGO == 1)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1475 if (Trans_active)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1476 {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1477 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1478 if (SNR_val>= L1_TOA_SNR_THRESHOLD)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1479 {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1480 cumul_counter++;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1481
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1482 prod_tmp = L1_TOA_LAMBDA * cumul;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1483 prod_tmp = prod_tmp + ((0x00004000)); // basically for rounding
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1484 div_tmp = ((prod_tmp >> 15) & (0x0000FFFF));
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1485 cumul = div_tmp;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1486
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1487 // implemented below is
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1488 // cumul = cumul + (L1_TOA_ONE_MINUS_LAMBDA * signum(TOA_Val - L1_TOA_EXPECTED_TOA))
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1489 if(TOA_val > L1_TOA_EXPECTED_TOA) {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1490 cumul = cumul + L1_TOA_ONE_MINUS_LAMBDA;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1491 }
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1492 else if (TOA_val < L1_TOA_EXPECTED_TOA) {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1493 cumul = cumul - L1_TOA_ONE_MINUS_LAMBDA;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1494 }
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1495 } // End if SNR_val
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1496
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1497 if(l1s.toa_var.toa_update_flag == TRUE)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1498 {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1499 toa_update_flag = 1;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1500 }
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1501
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1502 if (toa_update_flag)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1503 {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1504 cumul_sign = (cumul>0)? 1: -1;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1505 cumul_abs = cumul_sign*cumul;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1506 if(cumul_counter <= 5)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1507 {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1508 TOA_SHIFT = (cumul_abs<=L1_TOA_THRESHOLD_15)? 0: cumul_sign;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1509 }
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1510 else if(cumul_counter == 6)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1511 {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1512 TOA_SHIFT = (cumul_abs<=L1_TOA_THRESHOLD_20)? 0: cumul_sign;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1513 }
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1514 else if(cumul_counter == 7)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1515 {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1516 TOA_SHIFT = (cumul_abs<=L1_TOA_THRESHOLD_25)? 0: cumul_sign;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1517 }
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1518 else if(cumul_counter >= 8)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1519 {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1520 TOA_SHIFT = (cumul_abs<=L1_TOA_THRESHOLD_30)? 0: cumul_sign;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1521 }
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1522 #if (TRACE_TYPE==1) \|\| (TRACE_TYPE==4)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1523 trace_info.toa_trace_var.toa_accumul_value = cumul;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1524 trace_info.toa_trace_var.toa_accumul_counter = cumul_counter;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1525 trace_info.toa_trace_var.toa_frames_counter = l1s.toa_var.toa_frames_counter;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1526 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1527
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1528 cumul = 0;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1529 cumul_counter = 0;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1530 l1s.toa_var.toa_frames_counter = 0;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1531 l1s.toa_var.toa_update_flag = FALSE;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1532
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1533 #if (TOA_DEBUG_ENABLE == 1)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1534 #if (TOA_MAKE_ZERO == 1)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1535 if (toa_make_zero_f == 1)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1536 {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1537 TOA_SHIFT=0;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1538 }
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1539 #endif /#if (TOA_DEBUG_ENABLE == 1)/
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1540 #endif /#if (TOA_MAKE_ZERO == 1)/
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1541
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1542 } // end of if toa_update_flag
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1543 #if (NEW_TOA_ALGO == 1)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1544
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1545 }
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1546
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1547 else
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1548 {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1549 period_counter_noTrans++;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1550
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1551 if (SNR_val>= L1_TOA_SNR_THRESHOLD)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1552 {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1553 cumul_noTrans = cumul_noTrans + TOA_val - L1_TOA_EXPECTED_TOA;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1554
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1555 } // End if SNR_val
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1556
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1557 if (l1s.toa_var.toa_update_flag == TRUE)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1558 {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1559 switch (period_counter_noTrans)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1560 {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1561 case 2:
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1562 if (cumul_noTrans>=0)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1563 TOA_SHIFT = (cumul_noTrans+1) >>1 ;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1564 else
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1565 TOA_SHIFT = (cumul_noTrans) >>1 ;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1566 break;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1567 case 3: /* Not fully accurate rounding*/
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1568 if (cumul_noTrans>=0)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1569 TOA_SHIFT = (cumul_noTrans+2)/3 ;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1570 else
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1571 TOA_SHIFT = (cumul_noTrans-2)/3 ;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1572 break;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1573 case 4:
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1574 if (cumul_noTrans>=0)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1575 TOA_SHIFT = (cumul_noTrans+2) >>2 ;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1576 else
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1577 TOA_SHIFT = (cumul_noTrans+1) >>2 ;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1578 break;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1579 default:
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1580 TOA_SHIFT = cumul_noTrans;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1581 break;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1582 } /* end switch*/
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1583
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1584 if (TOA_SHIFT>8)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1585 TOA_SHIFT =8;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1586 if (TOA_SHIFT<-8)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1587 TOA_SHIFT =-8;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1588
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1589 #if (TRACE_TYPE==1) \|\| (TRACE_TYPE==4)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1590 trace_info.toa_trace_var.toa_accumul_value = cumul_noTrans;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1591 trace_info.toa_trace_var.toa_accumul_counter = period_counter_noTrans;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1592 trace_info.toa_trace_var.toa_frames_counter = period_counter_noTrans;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1593 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1594
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1595 cumul_noTrans = 0;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1596 period_counter_noTrans = 0;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1597 l1s.toa_var.toa_update_flag = FALSE;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1598 #if (TOA_DEBUG_ENABLE == 1)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1599 #if (TOA_MAKE_ZERO == 1)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1600 if (toa_make_zero_f == 1)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1601 {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1602 TOA_SHIFT=0;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1603 }
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1604 #endif /#if (TOA_DEBUG_ENABLE == 1)/
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1605 #endif /#if (TOA_MAKE_ZERO == 1)/
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1606
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1607 } // end if update_flag
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1608 }
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1609 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1610 // error a TOA is waiting to be updated in the TPU and will be erased
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1611 #if (TRACE_TYPE==1) \|\| (TRACE_TYPE==4)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1612 if (l1s.toa_var.toa_shift != ISH_INVALID)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1613 {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1614 l1_trace_toa_not_updated (); // should not occur!!
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1615 }
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1616 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1617
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1618 if (TOA_SHIFT != ISH_INVALID) // new TOA => set the mask frames
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1619 {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1620 // Set mask counter to 2 (2 frames masked).
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1621 l1s.toa_var.toa_snr_mask = 2;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1622 }
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1623
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1624 l1s.toa_var.toa_accumul_value = cumul;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1625 l1s.toa_var.toa_accumul_counter = cumul_counter;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1626
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1627 return(TOA_SHIFT);
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1628
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1629 } // l1ctl_toa
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1630
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1631
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1632 #else
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1633 /-------------------------------------------------------/
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1634 /* l1ctl_toa_update() */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1635 /-------------------------------------------------------/
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1636 /* Parameters : */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1637 /* Return : */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1638 /* Functionality : */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1639 /-------------------------------------------------------/
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1640 WORD16 l1ctl_toa_update(UWORD32 *TOASP, UWORD32 l1_mode)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1641 {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1642 static UWORD16 Old_TOA_estimated=12; //unit is Qbit
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1643 UWORD32 TOAMAX;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1644 WORD16 IZW,ISH,i;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1645 UWORD32 TOA_estimated=0; //unit is Qbit
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1646 UWORD16 Trans_active;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1647
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1648 if ((l1_mode==CON_EST_MODE2)\|\|(l1_mode==DEDIC_MODE)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1649 #if L1_GPRS
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1650 \|\| l1_mode==PACKET_TRANSFER_MODE
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1651 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1652 )
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1653 Trans_active=TRUE;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1654 else Trans_active=FALSE;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1655
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1656 /* TOA offset computation and clock adjustement */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1657 TOAMAX=0;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1658 for (i=1;i<TOA_HISTO_LEN;i++)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1659 {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1660 if (TOASP[i]>TOAMAX)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1661 TOAMAX=TOASP[i];
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1662 }
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1663 TOAMAX >>= C_RED;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1664 i=1;IZW=0;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1665 while (i<TOA_HISTO_LEN && IZW==0)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1666 {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1667 if (TOASP[i]>=TOAMAX)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1668 IZW=i;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1669 i++;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1670 }
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1671
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1672 /* Estimated TOA calculation */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1673 if (TOASP[IZW-1]<(2*TOAMAX/3))
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1674 {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1675 TOA_estimated=IZW;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1676 TOA_estimated *= 4; // unit in QBit
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1677 }
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1678 else
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1679 {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1680 #if 0 /* fix added in LoCosto, not present in TCS211 */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1681 UWORD32 TOA_divisor;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1682 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1683 TOA_estimated=(TOASP[IZW]IZW)+(TOASP[IZW-1](IZW-1)>>C_GEW);
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1684 TOA_estimated *= 8; //F13.3 in order to have qBit precision
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1685 #if 0
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1686 TOA_divisor = TOASP[IZW]+(TOASP[IZW-1] >> C_GEW);
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1687 if (TOA_divisor!=0)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1688 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1689 {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1690 TOA_estimated /= TOASP[IZW]+(TOASP[IZW-1] >> C_GEW);
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1691 TOA_estimated /= 2; // unit in QBit ("/8" then "*4" = "/2")
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1692 }
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1693 #if 0
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1694 else
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1695 {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1696 TOA_estimated = 0;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1697 }
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1698 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1699 }
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1700
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1701 if (Trans_active)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1702 TOA_estimated=(TOA_estimated+(Old_TOA_estimated+4)) / 2;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1703
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1704 /* Offset calculation*/
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1705 if (TOA_estimated>=17 \|\| TOA_estimated<=15)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1706 ISH=TOA_estimated - 16;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1707 else
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1708 ISH=0;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1709
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1710 if (Trans_active)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1711 {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1712 if (ISH>1) ISH=1;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1713 if (ISH<-1) ISH=-1;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1714 }
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1715 else
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1716 {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1717 if (ISH>8) ISH=8;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1718 if (ISH<-8) ISH=-8;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1719 }
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1720
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1721 Old_TOA_estimated = TOA_estimated - ISH - 4;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1722
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1723
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1724 return (ISH);
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1725 }
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1726
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1727 /-------------------------------------------------------/
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1728 /* l1ctl_toa() */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1729 /-------------------------------------------------------/
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1730 /* Parameters : */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1731 /* Return : */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1732 /* Functionality : generate an histogram of TOA weighted */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1733 /* with SNR */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1734 /-------------------------------------------------------/
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1735 WORD16 l1ctl_toa(UWORD8 phase, UWORD32 l1_mode, UWORD16 SNR_val, UWORD16 TOA_val, BOOL toa_update, UWORD16 toa_period_count
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1736 #if (FF_L1_FAST_DECODING == 1)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1737 , UWORD8 skipped_values
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1738 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1739 )
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1740 {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1741 // xSignalHeaderRec *msg;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1742 UWORD16 i;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1743 WORD16 TOA_period_len = TOA_PERIOD_LEN[l1_mode];
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1744 static UWORD32 histo[TOA_HISTO_LEN];
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1745 static WORD16 period_counter=0;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1746 UWORD32 SNR_ZW;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1747 WORD16 ISH=ISH_INVALID;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1748
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1749 UWORD8 histo_center;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1750
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1751 #if 0
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1752 if ((l1_mode==CON_EST_MODE2)\|\|(l1_mode==DEDIC_MODE))
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1753 histo_center=4;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1754 else
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1755 histo_center=5;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1756 #else
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1757 histo_center=4;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1758 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1759
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1760
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1761 if (phase==TOA_INIT)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1762 {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1763 period_counter=0;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1764
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1765 for (i=0;i<TOA_HISTO_LEN;i++)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1766 histo[i]=0;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1767 histo[histo_center]=128; //F6.10
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1768
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1769 return(ISH);
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1770 }
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1771 #if (FF_L1_FAST_DECODING == 1)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1772 /* Manage any missing bursts due to fast decoding */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1773 period_counter += skipped_values;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1774 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1775
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1776 period_counter++;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1777 /* Filter update */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1778 if (SNR_val>=C_SNRGR)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1779 {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1780 if (SNR_val>C_SNR_THR)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1781 SNR_ZW=C_SNR_THR;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1782 else
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1783 SNR_ZW=SNR_val;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1784 histo[TOA_val+1]+=SNR_ZW; /* if TOA=0 histo[1]++ */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1785 /* if TOA=1 histo[2]++ */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1786 /* ... */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1787 /* if TOA=9 histo[10]++ */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1788 /* histo[0] is reserved for computation */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1789 }
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1790
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1791 #if L1_GPRS
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1792 if (l1_mode==PACKET_TRANSFER_MODE)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1793 {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1794 if (*toa_update)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1795 {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1796 // Get ISH.
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1797 ISH = l1ctl_toa_update(histo, l1_mode);
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1798
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1799 //reset TOA period length counter
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1800 period_counter=0;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1801
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1802 //reset histogram
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1803 for (i=0;i<TOA_HISTO_LEN;i++)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1804 histo[i]=0;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1805 histo[histo_center]=128; //F6.10
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1806
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1807 *toa_update = FALSE; // reset TOA update flag
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1808 *toa_period_count = 0; // reset TOA period counter
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1809 }
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1810 }
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1811 else
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1812 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1813 if (period_counter>=TOA_period_len)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1814 // It is time to compute a new ISH and to reset the histogram.
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1815 // Rem: ">=" is very important since a "l1 mode" change can give
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1816 // a "TOA_period_len" smaller than the previous one an
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1817 // therefore a "period_counter" may be already higher than
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1818 // the new "TOA_period_len".
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1819 {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1820 // Get ISH.
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1821 ISH = l1ctl_toa_update(histo, l1_mode);
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1822
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1823 //reset TOA period length counter
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1824 period_counter=0;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1825
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1826 //reset histogram
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1827 for (i=0;i<TOA_HISTO_LEN;i++)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1828 histo[i]=0;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1829 histo[histo_center]=128; //F6.10
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1830 }
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1831
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1832 // error a TOA is waiting to be updated in the TPU and will be erased
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1833 #if (TRACE_TYPE==1) \|\| (TRACE_TYPE==4)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1834 if (l1s.toa_shift != ISH_INVALID)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1835 {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1836 l1_trace_toa_not_updated(); // should not occur !!
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1837 }
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1838 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1839
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1840 if (ISH != ISH_INVALID) // new TOA => set the mask frames
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1841 {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1842 // Set mask counter to 2 (2 frames masked).
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1843 l1s.toa_snr_mask = 2;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1844 }
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1845
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1846 return(ISH);
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1847 }
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1848 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1849
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1850 /-------------------------------------------------------/
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1851 /* l1ctl_txpwr() */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1852 /-------------------------------------------------------/
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1853 /* Parameters : */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1854 /* Return : */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1855 /* Functionality : */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1856 /-------------------------------------------------------/
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1857 UWORD8 l1ctl_txpwr(UWORD8 target_txpwr, UWORD8 current_txpwr)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1858 {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1859 if(target_txpwr > current_txpwr)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1860 {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1861 current_txpwr ++; // Increase TX power by 2 dB.
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1862 }
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1863 else
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1864 if(target_txpwr < current_txpwr)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1865 {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1866 current_txpwr --; // Decrease TX power by 2 dB.
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1867 }
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1868
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1869 return(current_txpwr);
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1870 }
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1871
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1872
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1873 /************************************/
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1874 /* Automatic Gain Control */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1875 /************************************/
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1876 /-------------------------------------------------------/
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1877 /* l1ctl_encode_delta1() */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1878 /-------------------------------------------------------/
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1879 /* Parameters : */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1880 /* Return : */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1881 /* Functionality : */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1882 /-------------------------------------------------------/
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1883 #if(L1_FF_MULTIBAND == 0)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1884 WORD8 l1ctl_encode_delta1(UWORD16 radio_freq)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1885 {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1886 WORD8 freq_band;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1887
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1888 switch(l1_config.std.id)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1889 {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1890 case GSM:
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1891 case GSM_E:
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1892 case DCS1800:
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1893 case PCS1900:
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1894 case GSM850:
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1895 freq_band = l1_config.std.cal_freq1_band1;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1896 break;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1897 case DUAL:
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1898 case DUALEXT:
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1899 case DUAL_US:
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1900 if(radio_freq >= l1_config.std.first_radio_freq_band2)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1901 freq_band = l1_config.std.cal_freq1_band2;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1902 else
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1903 freq_band = l1_config.std.cal_freq1_band1;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1904 break;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1905 }
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1906 return(freq_band);
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1907 }
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1908 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1909 /-------------------------------------------------------/
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1910 /* l1ctl_encode_lna() */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1911 /-------------------------------------------------------/
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1912 /* Parameters : */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1913 /* Return : */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1914 /* Functionality : */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1915 /-------------------------------------------------------/
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1916 #if (L1_FF_MULTIBAND == 0)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1917 void l1ctl_encode_lna( UWORD8 input_level,
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1918 UWORD8 *lna_state,
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1919 UWORD16 radio_freq)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1920 {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1921
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1922 /*** LNA Hysteresis is implemented as following :
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1923
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1924 \|
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1925 On\|---<>----+-------+
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1926 \| \| \|
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1927 LNA \| \| \|
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1928 \| ^ v
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1929 \| \| \|
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1930 \| \| \|
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1931 Off\| +-------+----<>-----
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1932 +--------------------------------
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1933 50 40 30 20 input_level /-dBm
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1934 THR_HIGH THR_LOW ***/
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1935
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1936
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1937
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1938
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1939
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1940 if(((l1_config.std.id == DUAL) \|\| (l1_config.std.id == DUALEXT) \|\|(l1_config.std.id == DUAL_US)) &&
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1941 (radio_freq >= l1_config.std.first_radio_freq_band2))
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1942 {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1943 if ( input_level > l1_config.std.lna_switch_thr_high_band2 ) // < -40dBm ?
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1944 {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1945 *lna_state = LNA_ON; // lna_off = FALSE
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1946 }
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1947 else if ( input_level < l1_config.std.lna_switch_thr_low_band2 ) // > -30dBm ?
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1948 {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1949 *lna_state = LNA_OFF; // lna off = TRUE
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1950 }
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1951 }
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1952 else
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1953 {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1954 if ( input_level > l1_config.std.lna_switch_thr_high_band1 ) // < -40dBm ?
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1955 {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1956 *lna_state = LNA_ON; // lna_off = FALSE
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1957 }
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1958 else if ( input_level < l1_config.std.lna_switch_thr_low_band1 ) // > -30dBm ?
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1959 {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1960 *lna_state = LNA_OFF; // lna off = TRUE
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1961 }
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1962 }
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1963
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1964 }
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1965
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1966 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1967
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1968 /-------------------------------------------------------/
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1969 /* l1ctl_csgc() */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1970 /-------------------------------------------------------/
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1971 /* Description: */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1972 /* ============ */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1973 /* If we are running the first pass of a measurement */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1974 /* session, we use the HIGH_AGC default agc setting to */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1975 /* compute the input level from the measured power from */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1976 /* the DSP. If this input level is saturated we set a */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1977 /* saturation flag, otherwise we validate the measure and*/
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1978 /* store, for the considered carrier, the input level. */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1979 /* When all the carriers have been scanned and some have */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1980 /* been flagged "saturated", we measure them with the */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1981 /* LOW_AGC agc setting, then store, for the considered */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1982 /* carrier, the input level. */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1983 /-------------------------------------------------------/
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1984 UWORD8 l1ctl_csgc(UWORD8 pm, UWORD16 radio_freq)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1985 {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1986 WORD16 current_IL, current_calibrated_IL;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1987 WORD8 delta1_freq, delta2_freq;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1988 WORD16 delta_drp_gain=0;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1989 UWORD32 index;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1990 UWORD16 g_magic;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1991 #if (RF_FAM == 61) && (L1_FF_MULTIBAND == 0)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1992 UWORD16 arfcn;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1993 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1994 UWORD16 dco_algo_ctl_pw_temp = 0;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1995 UWORD8 if_ctl = 0;
73 af1bacf61dc6 src/cs/layer1/cfile/l1_ctl.c: fix for typo made during reconstruction Mychaela Falconia <falcon@freecalypso.org> parents: 69 diff changeset	1996 #if (RF_FAM == 61) && (CODE_VERSION != SIMULATION)
69 50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1997 UWORD8 if_threshold = C_IF_ZERO_LOW_THRESHOLD_GSM;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1998 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1999
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2000 #if (L1_FF_MULTIBAND == 0)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2001
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2002 // initialize index
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2003 index = radio_freq - l1_config.std.radio_freq_index_offset;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2004
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2005 #else
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2006
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2007 index =
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2008 l1_multiband_radio_freq_convert_into_operative_radio_freq(radio_freq);
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2009
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2010 #endif /if(L1_FF_MULTIBAND == 0)/
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2011
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2012 delta1_freq = l1ctl_encode_delta1(radio_freq);
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2013 delta2_freq = l1ctl_encode_delta2(radio_freq);
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2014
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2015 g_magic = l1ctl_get_g_magic(radio_freq);
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2016
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2017 #if (RF_FAM == 61) && (L1_FF_MULTIBAND == 0)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2018 arfcn = Convert_l1_radio_freq(radio_freq);
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2019 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2020
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2021 if (l1a_l1s_com.full_list.meas_1st_pass_read)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2022 {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2023 // We validate or not power measure (pm) for the considered carrier
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2024 // with measurement achieved with HIGH_AGC setting. We are working
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2025 // with non calibrated IL to avoid saturation
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2026 #if(RF_FAM == 61)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2027 #if (CODE_VERSION != SIMULATION)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2028
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2029 #if (PWMEAS_IF_MODE_FORCE == 0)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2030 cust_get_if_dco_ctl_algo(&dco_algo_ctl_pw_temp, &if_ctl, (UWORD8) L1_IL_INVALID ,
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2031 0,
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2032 radio_freq,if_threshold);
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2033 #else
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2034 if_ctl = IF_120KHZ_DSP;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2035 dco_algo_ctl_pw_temp = DCO_IF_0KHZ;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2036 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2037
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2038 #if (L1_FF_MULTIBAND == 0)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2039 delta_drp_gain = drp_gain_correction(arfcn, LNA_ON, (l1_config.params.high_agc << 1)); // F7.1 format
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2040 #else
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2041 delta_drp_gain = drp_gain_correction(radio_freq, LNA_ON, (l1_config.params.high_agc << 1)); // F7.1 format
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2042 #endif // MULTIBAND == 0 else
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2043
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2044 if(if_ctl == IF_100KHZ_DSP){
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2045 delta_drp_gain += SCF_ATTENUATION_LIF_100KHZ;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2046 }
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2047 else{ /* i.e. if_ctl = IF_120KHZ_DSP*/
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2048 delta_drp_gain += SCF_ATTENUATION_LIF_120KHZ;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2049 }
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2050
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2051 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2052 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2053 if (0==pm) // Check and filter illegal pm value by using last valid IL
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2054 current_IL = (WORD16)(l1a_l1s_com.last_input_level[index].input_level);
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2055 else
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2056 {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2057 #if TESTMODE
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2058 if (!l1_config.agc_enable)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2059 current_IL = (WORD16)(-(pm - ( (l1_config.tmode.rx_params.agc << 1) - delta_drp_gain ) - g_magic));
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2060 else
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2061 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2062 current_IL = (WORD16)(-(pm - ( (l1_config.params.high_agc <<1) - delta_drp_gain) - g_magic));
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2063 // for array index purpose, we work with positive IL
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2064
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2065 }
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2066
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2067 // NOTE: lna_value do not appear in this formula because lna is ALWAYS ON for
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2068 // ---- this algorithm, so lna_value=lna_off*l1_config.params.lna_att_gsm=0
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2069
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2070 if ((current_IL<l1_config.params.high_agc_sat_thr) // Warning : we are working with positive IL
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2071 // for IL_2_AGC_xx index purpose.
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2072 #if TESTMODE
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2073 && (l1_config.agc_enable)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2074 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2075 )
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2076 {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2077 // pm is saturated so measure is not valid
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2078 l1a_l1s_com.full_list.nbr_sat_carrier_ctrl++;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2079 l1a_l1s_com.full_list.nbr_sat_carrier_read++;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2080 l1a_l1s_com.full_list.sat_flag[l1a_l1s_com.full_list.next_to_read] = 1;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2081 }
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2082 else
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2083 {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2084 current_calibrated_IL = current_IL - delta1_freq - delta2_freq;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2085
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2086 #if TESTMODE
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2087 // When running with fixed AGC setting saturated carriers may occur:
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2088 // protect against negative IL;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2089 if ((!l1_config.agc_enable) && (current_calibrated_IL < 0))
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2090 {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2091 current_calibrated_IL=0;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2092 current_IL=0;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2093 }
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2094 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2095
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2096 // Protect IL stores against overflow
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2097 if (current_calibrated_IL>INDEX_MAX)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2098 current_calibrated_IL=INDEX_MAX;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2099 if (current_IL>INDEX_MAX)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2100 current_IL=INDEX_MAX;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2101
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2102 // we validate the measure and save input_level and lna_off fields.
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2103 l1ctl_encode_lna((UWORD8)(current_calibrated_IL>>1),
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2104 &(l1a_l1s_com.last_input_level[index].lna_off),
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2105 radio_freq);
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2106
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2107 l1a_l1s_com.last_input_level[index].input_level = (UWORD8)current_IL +
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2108 l1ctl_get_lna_att(radio_freq) *
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2109 l1a_l1s_com.last_input_level[index].lna_off;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2110
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2111 l1a_l1s_com.full_list.sat_flag[l1a_l1s_com.full_list.next_to_read] = 0;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2112 }
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2113 }
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2114 else // 2nd pass if any.
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2115 {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2116 // we validate the measure and save input_level and lna_off(always 0)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2117 // fields.
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2118 #if(RF_FAM == 61)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2119 #if (CODE_VERSION != SIMULATION)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2120 cust_get_if_dco_ctl_algo(&dco_algo_ctl_pw_temp, &if_ctl, (UWORD8) L1_IL_INVALID,
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2121 0,radio_freq,if_threshold);
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2122 #if (L1_FF_MULTIBAND == 0)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2123 delta_drp_gain = drp_gain_correction(arfcn, LNA_ON, (l1_config.params.low_agc << 1)); // F7.1 format
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2124 #else
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2125 delta_drp_gain = drp_gain_correction(radio_freq, LNA_ON, (l1_config.params.low_agc << 1)); // F7.1 format
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2126 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2127 if(if_ctl == IF_100KHZ_DSP){
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2128 delta_drp_gain += SCF_ATTENUATION_LIF_100KHZ;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2129 }
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2130 else{ /* i.e. if_ctl = IF_120KHZ_DSP*/
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2131 delta_drp_gain += SCF_ATTENUATION_LIF_120KHZ;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2132 }
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2133 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2134 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2135
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2136
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2137 if (0==pm) // Check and filter illegal pm value by using last valid IL
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2138 current_IL = (WORD16)(l1a_l1s_com.last_input_level[index].input_level);
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2139 else
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2140 current_IL = (WORD16)(-(pm - ( (l1_config.params.low_agc << 1) - delta_drp_gain ) - g_magic));
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2141
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2142 current_calibrated_IL = current_IL - delta1_freq - delta2_freq;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2143
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2144 // Protect IL stores against overflow
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2145 if (current_calibrated_IL>INDEX_MAX)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2146 current_calibrated_IL=INDEX_MAX;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2147 if (current_IL>INDEX_MAX)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2148 current_IL=INDEX_MAX;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2149
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2150 l1ctl_encode_lna((UWORD8)(current_calibrated_IL>>1),
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2151 &(l1a_l1s_com.last_input_level[index].lna_off),
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2152 radio_freq);
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2153
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2154 l1a_l1s_com.last_input_level[index].input_level = (UWORD8)current_IL +
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2155 l1ctl_get_lna_att(radio_freq) *
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2156 l1a_l1s_com.last_input_level[index].lna_off;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2157
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2158 l1a_l1s_com.full_list.sat_flag[l1a_l1s_com.full_list.next_to_read] = 0;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2159 }
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2160
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2161 return((UWORD8)current_calibrated_IL);
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2162 }
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2163
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2164 /-------------------------------------------------------/
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2165 /* l1ctl_pgc() */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2166 /-------------------------------------------------------/
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2167 /* Description : For a given radio_freq, last_known_agc is */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2168 /* ============ based on a prior knowledge (the last */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2169 /* stored input_level for the considered */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2170 /* carrier). From the power measurement on */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2171 /* this carrier (pm), we update the */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2172 /* input_level for this carrier, for the */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2173 /* next task to control. */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2174 /-------------------------------------------------------/
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2175 UWORD8 l1ctl_pgc(UWORD8 pm, UWORD8 last_known_il,
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2176 UWORD8 lna_off, UWORD16 radio_freq)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2177 {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2178 WORD32 last_known_agc;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2179 WORD32 current_IL, current_calibrated_IL;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2180 WORD8 delta1_freq, delta2_freq;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2181 WORD16 delta_drp_gain=0;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2182 WORD32 index, lna_value;
73 af1bacf61dc6 src/cs/layer1/cfile/l1_ctl.c: fix for typo made during reconstruction Mychaela Falconia <falcon@freecalypso.org> parents: 69 diff changeset	2183 #if (RF_FAM == 61) && (CODE_VERSION != SIMULATION)
69 50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2184 UWORD16 arfcn;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2185 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2186 UWORD16 dco_algo_ctl_pw_temp = 0;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2187 UWORD8 if_ctl = 0;
73 af1bacf61dc6 src/cs/layer1/cfile/l1_ctl.c: fix for typo made during reconstruction Mychaela Falconia <falcon@freecalypso.org> parents: 69 diff changeset	2188 #if (RF_FAM == 61) && (CODE_VERSION != SIMULATION)
69 50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2189 UWORD8 if_threshold = C_IF_ZERO_LOW_THRESHOLD_GSM;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2190 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2191
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2192 #if (L1_FF_MULTIBAND == 0)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2193
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2194 // initialize index
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2195 index = radio_freq - l1_config.std.radio_freq_index_offset;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2196
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2197 #else
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2198
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2199 index = l1_multiband_radio_freq_convert_into_operative_radio_freq(radio_freq);
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2200
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2201 #endif // #if (L1_FF_MULTIBAND == 0) else
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2202
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2203 delta1_freq = l1ctl_encode_delta1(radio_freq);
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2204 delta2_freq = l1ctl_encode_delta2(radio_freq);
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2205
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2206 lna_value = lna_off * l1ctl_get_lna_att(radio_freq);
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2207
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2208 last_known_agc = (Cust_get_agc_from_IL(radio_freq, last_known_il >> 1, PWR_ID)) << 1;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2209 // F7.1 in order to be compatible with
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2210 // pm and IL formats [-20,+140 in F7.1]
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2211 // contain the input_level value we use
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2212 // in the associated CTL task to build
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2213 // the agc used in this CTL.
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2214
73 af1bacf61dc6 src/cs/layer1/cfile/l1_ctl.c: fix for typo made during reconstruction Mychaela Falconia <falcon@freecalypso.org> parents: 69 diff changeset	2215 #if (RF_FAM == 61) && (CODE_VERSION != SIMULATION)
69 50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2216 #if (L1_FF_MULTIBAND == 0)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2217 arfcn = Convert_l1_radio_freq(radio_freq);
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2218 #else
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2219 arfcn = radio_freq;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2220 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2221 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2222
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2223 #if(RF_FAM == 61)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2224 #if (CODE_VERSION != SIMULATION)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2225
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2226 #if (PWMEAS_IF_MODE_FORCE == 0)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2227 cust_get_if_dco_ctl_algo(&dco_algo_ctl_pw_temp, &if_ctl, (UWORD8) L1_IL_VALID ,
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2228 last_known_il,
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2229 radio_freq,if_threshold);
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2230 #else
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2231 if_ctl = IF_120KHZ_DSP;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2232 dco_algo_ctl_pw_temp = DCO_IF_0KHZ;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2233 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2234
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2235 delta_drp_gain = drp_gain_correction(arfcn, lna_off, last_known_agc); // F7.1 format
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2236 if(if_ctl == IF_100KHZ_DSP){
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2237 delta_drp_gain += SCF_ATTENUATION_LIF_100KHZ;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2238 }
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2239 else{ /* i.e. if_ctl = IF_120KHZ_DSP*/
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2240 delta_drp_gain += SCF_ATTENUATION_LIF_120KHZ;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2241 }
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2242
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2243 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2244 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2245
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2246 if (0==pm) // Check and filter illegal pm value by using last valid IL
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2247 current_IL = l1a_l1s_com.last_input_level[index].input_level - lna_value;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2248 else
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2249 current_IL = -(pm - (last_known_agc - delta_drp_gain) + lna_value - l1ctl_get_g_magic(radio_freq));
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2250
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2251 current_calibrated_IL = current_IL - delta1_freq - delta2_freq;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2252
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2253 // Protect IL stores against overflow
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2254 if (current_calibrated_IL>INDEX_MAX)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2255 current_calibrated_IL=INDEX_MAX;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2256 if (current_IL>INDEX_MAX)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2257 current_IL=INDEX_MAX;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2258
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2259 // we validate the measure and save input_level and lna_off fields
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2260 l1ctl_encode_lna((UWORD8)(current_calibrated_IL>>1),
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2261 &(l1a_l1s_com.last_input_level[index].lna_off),
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2262 radio_freq);
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2263
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2264 l1a_l1s_com.last_input_level[index].input_level = (UWORD8)current_IL +
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2265 l1ctl_get_lna_att(radio_freq) *
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2266 l1a_l1s_com.last_input_level[index].lna_off;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2267
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2268 return((UWORD8)current_calibrated_IL);
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2269 }
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2270
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2271
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2272 /-------------------------------------------------------/
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2273 /* l1ctl_pgc2() */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2274 /-------------------------------------------------------/
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2275 /* Description : */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2276 /* ============= */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2277 /* from power measurement pm_high_agc, */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2278 /* achieve with an HIGH_AGC setting, and pm_low_agc */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2279 /* achieve with a LOW_AGC seeting, we deduce the new */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2280 /* AGC to apply in the next CTL task. */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2281 /-------------------------------------------------------/
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2282 void l1ctl_pgc2(UWORD8 pm_high_agc, UWORD8 pm_low_agc, UWORD16 radio_freq)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2283 {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2284 UWORD8 pm;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2285 WORD32 IL_high_agc, IL_low_agc, new_IL, current_calibrated_IL;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2286 WORD8 delta1_freq, delta2_freq;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2287 WORD16 delta_high_drp_gain=0;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2288 WORD16 delta_low_drp_gain=0;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2289 WORD32 index;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2290 UWORD16 g_magic;
73 af1bacf61dc6 src/cs/layer1/cfile/l1_ctl.c: fix for typo made during reconstruction Mychaela Falconia <falcon@freecalypso.org> parents: 69 diff changeset	2291 #if (RF_FAM == 61) && (CODE_VERSION != SIMULATION)
69 50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2292 UWORD16 arfcn;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2293 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2294 UWORD16 dco_algo_ctl_pw_temp = 0;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2295 UWORD8 if_ctl = 0;
73 af1bacf61dc6 src/cs/layer1/cfile/l1_ctl.c: fix for typo made during reconstruction Mychaela Falconia <falcon@freecalypso.org> parents: 69 diff changeset	2296 #if (RF_FAM == 61) && (CODE_VERSION != SIMULATION)
69 50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2297 UWORD8 if_threshold = C_IF_ZERO_LOW_THRESHOLD_GSM;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2298 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2299
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2300 #if (L1_FF_MULTIBAND == 0)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2301
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2302 // initialize index
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2303 index = radio_freq - l1_config.std.radio_freq_index_offset;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2304
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2305 #else
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2306
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2307 index =
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2308 l1_multiband_radio_freq_convert_into_operative_radio_freq(radio_freq);
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2309
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2310 #endif // #if (L1_FF_MULTIBAND == 0) else
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2311
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2312 delta1_freq = l1ctl_encode_delta1(radio_freq);
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2313 delta2_freq = l1ctl_encode_delta2(radio_freq);
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2314
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2315 g_magic = l1ctl_get_g_magic(radio_freq);
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2316
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2317 // lna_off was set to 0 during CTRL, so lna_value = 0 do not appear in the following
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2318 // formula.
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2319
73 af1bacf61dc6 src/cs/layer1/cfile/l1_ctl.c: fix for typo made during reconstruction Mychaela Falconia <falcon@freecalypso.org> parents: 69 diff changeset	2320 #if (RF_FAM == 61) && (CODE_VERSION != SIMULATION)
69 50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2321 #if (L1_FF_MULTIBAND == 0)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2322 arfcn = Convert_l1_radio_freq(radio_freq);
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2323 #else
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2324 arfcn = radio_freq;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2325 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2326 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2327
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2328 if ((0==pm_high_agc) \|\| (0==pm_low_agc)) // Check and filter illegal pm value(s) by using last valid IL
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2329 new_IL = l1a_l1s_com.last_input_level[index].input_level;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2330 else
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2331 {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2332
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2333 #if(RF_FAM == 61)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2334 #if (CODE_VERSION != SIMULATION)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2335
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2336 #if (PWMEAS_IF_MODE_FORCE == 0)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2337 cust_get_if_dco_ctl_algo(&dco_algo_ctl_pw_temp, &if_ctl, (UWORD8) L1_IL_INVALID ,
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2338 0,
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2339 radio_freq,if_threshold);
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2340 #else
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2341 if_ctl = IF_120KHZ_DSP;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2342 dco_algo_ctl_pw_temp = DCO_IF_0KHZ;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2343 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2344
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2345
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2346 delta_high_drp_gain = drp_gain_correction(arfcn, LNA_ON, (l1_config.params.high_agc << 1)); // F7.1 format
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2347 delta_low_drp_gain = drp_gain_correction(arfcn, LNA_ON, (l1_config.params.low_agc << 1)); // F7.1 format
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2348 if(if_ctl == IF_100KHZ_DSP){
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2349 delta_high_drp_gain += SCF_ATTENUATION_LIF_100KHZ;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2350 delta_low_drp_gain += SCF_ATTENUATION_LIF_100KHZ;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2351 }
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2352 else{ /* i.e. if_ctl = IF_120KHZ_DSP*/
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2353 delta_high_drp_gain += SCF_ATTENUATION_LIF_120KHZ;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2354 delta_low_drp_gain += SCF_ATTENUATION_LIF_120KHZ;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2355 }
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2356 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2357 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2358
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2359 IL_high_agc = -(pm_high_agc - ((l1_config.params.high_agc << 1) - delta_high_drp_gain) - g_magic);
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2360 IL_low_agc = -(pm_low_agc - ((l1_config.params.low_agc << 1) - delta_low_drp_gain) - g_magic);
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2361
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2362 // HIGH_AGC and LOW_AGC are formatted to F7.1 in order to be compatible with
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2363 // pm and IL formats
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2364
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2365 if (IL_low_agc>=l1_config.params.low_agc_noise_thr)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2366 // pm_low_agc was on the noise floor, so not valid
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2367 {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2368 // whatever the value of pm_high_agc, we consider it
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2369 // as the right setting
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2370 new_IL = IL_high_agc;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2371 pm = pm_high_agc;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2372 }
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2373 else
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2374 {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2375 // pm_low_agc is valid.
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2376 if (IL_high_agc<=l1_config.params.high_agc_sat_thr)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2377 {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2378 // pm_high_agc is not valid, it's saturated.
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2379 new_IL = IL_low_agc;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2380 pm = pm_low_agc;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2381 }
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2382 else
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2383 {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2384 // both pm_low_agc and pm_high_agc are valid, so we test the one that
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2385 // gives the maximum input level and consider it as the right setting.
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2386 if (IL_high_agc<=IL_low_agc)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2387 {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2388 new_IL = IL_high_agc;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2389 pm = pm_high_agc;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2390 }
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2391 else
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2392 {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2393 new_IL = IL_low_agc;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2394 pm = pm_low_agc;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2395 }
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2396 }
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2397 }
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2398 }
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2399
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2400 #if (TRACE_TYPE == 1) \|\| (TRACE_TYPE == 4)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2401 RTTL1_FILL_MON_MEAS(pm_high_agc, IL_high_agc - delta1_freq - delta2_freq, MS_AGC_ID, radio_freq)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2402 RTTL1_FILL_MON_MEAS(pm_low_agc, IL_low_agc - delta1_freq - delta2_freq, MS_AGC_ID, radio_freq)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2403 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2404
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2405 current_calibrated_IL = new_IL - delta1_freq - delta2_freq;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2406
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2407 // Protect IL stores against overflow
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2408 if (current_calibrated_IL>INDEX_MAX)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2409 current_calibrated_IL=INDEX_MAX;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2410 if (new_IL>INDEX_MAX)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2411 new_IL=INDEX_MAX;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2412
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2413 // Updating of input_level and lna_off fields in order to correctly
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2414 // setting the AGC for the next task.
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2415 l1ctl_encode_lna((UWORD8)(current_calibrated_IL>>1),
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2416 &(l1a_l1s_com.last_input_level[index].lna_off),
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2417 radio_freq);
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2418
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2419 l1a_l1s_com.last_input_level[index].input_level = (UWORD8)new_IL +
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2420 l1ctl_get_lna_att(radio_freq) *
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2421 l1a_l1s_com.last_input_level[index].lna_off;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2422 }
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2423
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2424
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2425 /-------------------------------------------------------/
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2426 /* l1ctl_find_max() */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2427 /-------------------------------------------------------/
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2428 /* Parameters : */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2429 /* Return : */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2430 /* Functionality : */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2431 /-------------------------------------------------------/
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2432 UWORD8 l1ctl_find_max(UWORD8 *buff, UWORD8 buffer_len)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2433 {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2434
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2435 // WARNING: for array index purpose we work with POSITIVE input level
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2436 // so maximum search for negative numbers is equivalent to
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2437 // minimum search for positive numbers!!!!!!
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2438 // (-30 > -120 but 30 < 120)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2439
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2440 UWORD8 maximum = 240;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2441 UWORD8 i;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2442
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2443 for (i=0; i<buffer_len; i++)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2444 {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2445 if (buff[i]<maximum)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2446 maximum=buff[i];
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2447 }
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2448
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2449 return(maximum);
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2450 }
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2451
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2452 /-------------------------------------------------------/
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2453 /* l1ctl_pagc() */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2454 /-------------------------------------------------------/
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2455 /* Description : */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2456 /* =========== */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2457 /* We deduce the last_known_agc from the last stored */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2458 /* input_level for the considered carrier. We use this */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2459 /* agc value to "build" the input level linked to the pm */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2460 /* we have just read. */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2461 /* This input level is used to feed a fifo of 4 elements */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2462 /* and then compute an input_level maximum. This value is*/
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2463 /* used to update the input_level for this carrier. This */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2464 /* input_level will be used for the next task to control.*/
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2465 /-------------------------------------------------------/
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2466 UWORD8 l1ctl_pagc(UWORD8 pm, UWORD16 radio_freq, T_INPUT_LEVEL *IL_info_ptr)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2467 {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2468 WORD8 delta1_freq, delta2_freq;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2469 WORD16 delta_drp_gain=0;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2470 WORD32 last_known_agc;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2471 UWORD8 IL_max;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2472 WORD32 current_IL, current_calibrated_IL;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2473 UWORD8 i;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2474 WORD32 lna_value;
73 af1bacf61dc6 src/cs/layer1/cfile/l1_ctl.c: fix for typo made during reconstruction Mychaela Falconia <falcon@freecalypso.org> parents: 69 diff changeset	2475 #if (RF_FAM == 61) && (CODE_VERSION != SIMULATION)
69 50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2476 UWORD16 arfcn;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2477 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2478 UWORD8 lna_off;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2479 UWORD16 dco_algo_ctl_pw_temp = 0;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2480 UWORD8 if_ctl = 0;
73 af1bacf61dc6 src/cs/layer1/cfile/l1_ctl.c: fix for typo made during reconstruction Mychaela Falconia <falcon@freecalypso.org> parents: 69 diff changeset	2481 #if (RF_FAM == 61) && (CODE_VERSION != SIMULATION)
69 50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2482 UWORD8 if_threshold = C_IF_ZERO_LOW_THRESHOLD_GSM;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2483 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2484
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2485 delta1_freq = l1ctl_encode_delta1(radio_freq);
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2486 delta2_freq = l1ctl_encode_delta2(radio_freq);
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2487
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2488 // Update fifo
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2489 for (i=3;i>0;i--)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2490 l1a_l1s_com.Scell_info.buff_beacon[i]=l1a_l1s_com.Scell_info.buff_beacon[i-1];
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2491
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2492 // from the lna state (ON/OFF) we compute the attenuation
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2493 // that was applied to signal when performing the power
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2494 // measure.
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2495 lna_value = l1a_l1s_com.Scell_used_IL_dd.lna_off * l1ctl_get_lna_att(radio_freq);
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2496
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2497 // Compute applied agc for this pm
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2498 last_known_agc = (Cust_get_agc_from_IL(radio_freq, l1a_l1s_com.Scell_used_IL_dd.input_level >> 1, MAX_ID)) << 1;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2499 // F7.1 in order to be compatible
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2500 // with pm and IL formats
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2501 // contain the input_level value we use
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2502 // in the associated CTL task to build
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2503 // the agc used in this CTL.
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2504
73 af1bacf61dc6 src/cs/layer1/cfile/l1_ctl.c: fix for typo made during reconstruction Mychaela Falconia <falcon@freecalypso.org> parents: 69 diff changeset	2505 #if (RF_FAM == 61) && (CODE_VERSION != SIMULATION)
69 50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2506 #if (L1_FF_MULTIBAND == 0)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2507 arfcn = Convert_l1_radio_freq(radio_freq);
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2508 #else
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2509 arfcn = radio_freq;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2510 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2511 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2512
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2513 #if(RF_FAM == 61)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2514 #if (CODE_VERSION != SIMULATION)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2515
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2516 cust_get_if_dco_ctl_algo(&dco_algo_ctl_pw_temp, &if_ctl, (UWORD8) L1_IL_VALID ,
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2517 l1a_l1s_com.Scell_used_IL_dd.input_level,
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2518 radio_freq,if_threshold);
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2519 lna_off = l1a_l1s_com.Scell_used_IL_dd.lna_off;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2520 delta_drp_gain = drp_gain_correction(arfcn, lna_off, last_known_agc); // F7.1 format
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2521 if(if_ctl == IF_100KHZ_DSP){
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2522 delta_drp_gain += SCF_ATTENUATION_LIF_100KHZ;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2523 }
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2524 else{ /* i.e. if_ctl = IF_120KHZ_DSP*/
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2525 delta_drp_gain += SCF_ATTENUATION_LIF_120KHZ;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2526 }
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2527
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2528 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2529 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2530
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2531 if (0==pm) // Check and filter illegal pm value by using last valid IL
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2532 current_IL = IL_info_ptr->input_level - lna_value;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2533 else
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2534 current_IL = -(pm - (last_known_agc - delta_drp_gain) + lna_value - l1ctl_get_g_magic(radio_freq));
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2535
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2536 current_calibrated_IL = current_IL - delta1_freq - delta2_freq;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2537
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2538 // Protect IL stores against overflow
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2539 if (current_calibrated_IL>INDEX_MAX)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2540 current_calibrated_IL=INDEX_MAX;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2541 if (current_IL>INDEX_MAX)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2542 current_IL=INDEX_MAX;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2543
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2544 l1a_l1s_com.Scell_info.buff_beacon[0] = (UWORD8)current_IL;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2545
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2546 IL_max = l1ctl_find_max(&(l1a_l1s_com.Scell_info.buff_beacon[0]),4);
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2547
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2548 //input levels are always stored with lna_on
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2549 l1ctl_encode_lna( (UWORD8)(current_calibrated_IL>>1),
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2550 &(IL_info_ptr->lna_off),
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2551 radio_freq );
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2552
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2553 IL_info_ptr->input_level = IL_max + l1ctl_get_lna_att(radio_freq) *
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2554 IL_info_ptr->lna_off;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2555
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2556 #if L2_L3_SIMUL
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2557 #if (DEBUG_TRACE==BUFFER_TRACE_PAGC)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2558 buffer_trace(4,IL_info_ptr->input_level,last_known_agc,
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2559 l1a_l1s_com.Scell_used_IL_dd.input_level,Cust_get_agc_from_IL(radio_freq, IL_max >> 1, MAX_ID));
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2560 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2561 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2562
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2563 return((UWORD8)current_calibrated_IL);
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2564 }
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2565
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2566 /-------------------------------------------------------/
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2567 /* l1ctl_dpagc() */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2568 /-------------------------------------------------------/
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2569 /* Description : */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2570 /* =========== */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2571 /* Based on the same principle as the one used for PAGC */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2572 /* algorithm except that we feed 3 different fifo: */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2573 /* 1) one is dedicated to BCCH carrier */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2574 /* 2) another one is dedicated to all the other type of */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2575 /* bursts */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2576 /* 3) the last one is dedicated to non DTX influenced */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2577 /* bursts */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2578 /-------------------------------------------------------/
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2579 UWORD8 l1ctl_dpagc(BOOL dtx_on, BOOL beacon, UWORD8 pm, UWORD16 radio_freq, T_INPUT_LEVEL *IL_info_ptr)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2580 {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2581 UWORD8 av_G_all, av_G_DTX;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2582 UWORD8 max_G_all, max_G_DTX;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2583 WORD32 last_known_agc, new_IL, current_calibrated_IL;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2584 WORD8 delta1_freq, delta2_freq;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2585 WORD16 delta_drp_gain=0;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2586 UWORD8 i;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2587 UWORD8 *tab_ptr;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2588 T_DEDIC_SET *aset;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2589 WORD32 lna_value;
73 af1bacf61dc6 src/cs/layer1/cfile/l1_ctl.c: fix for typo made during reconstruction Mychaela Falconia <falcon@freecalypso.org> parents: 69 diff changeset	2590 #if (RF_FAM == 61) && (CODE_VERSION != SIMULATION)
69 50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2591 UWORD16 arfcn;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2592 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2593 UWORD8 lna_off;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2594 UWORD16 dco_algo_ctl_pw_temp = 0;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2595 UWORD8 if_ctl = 0;
73 af1bacf61dc6 src/cs/layer1/cfile/l1_ctl.c: fix for typo made during reconstruction Mychaela Falconia <falcon@freecalypso.org> parents: 69 diff changeset	2596 #if (RF_FAM == 61) && (CODE_VERSION != SIMULATION)
69 50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2597 UWORD8 if_threshold = C_IF_ZERO_LOW_THRESHOLD_GSM;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2598 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2599
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2600 delta1_freq = l1ctl_encode_delta1(radio_freq);
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2601 delta2_freq = l1ctl_encode_delta2(radio_freq);
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2602
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2603 aset = l1a_l1s_com.dedic_set.aset;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2604
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2605 if (beacon)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2606 tab_ptr = l1a_l1s_com.Scell_info.buff_beacon;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2607 else
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2608 tab_ptr = aset->G_all;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2609
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2610 // Update fifo
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2611 for (i=DPAGC_FIFO_LEN-1;i>0;i--)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2612 tab_ptr[i]=tab_ptr[i-1];
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2613
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2614 #if TESTMODE
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2615 if (!l1_config.agc_enable)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2616 {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2617 // AGC gain can only be controlled in 2dB steps as the bottom bit (bit zero)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2618 // corresponds to the lna_off bit
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2619 last_known_agc = (l1_config.tmode.rx_params.agc) << 1;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2620 lna_value = (l1_config.tmode.rx_params.lna_off) * l1ctl_get_lna_att(radio_freq);
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2621 }
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2622 else
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2623 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2624 {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2625 #if DPAGC_MAX_FLAG
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2626 last_known_agc = (Cust_get_agc_from_IL(radio_freq, l1a_l1s_com.Scell_used_IL_dd.input_level >> 1, MAX_ID)) << 1;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2627 // F7.1 in order to be compatible with pm and IL formats
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2628 #else
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2629 last_known_agc = (Cust_get_agc_from_IL(radio_freq, l1a_l1s_com.Scell_used_IL_dd.input_level >> 1, AV_ID)) << 1;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2630 // F7.1 in order to be compatible with pm and IL formats
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2631 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2632 // input_level_dd : contain the input_level value we use
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2633 // in the associated CTL task to build the agc used in this CTL.
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2634
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2635 lna_value = l1a_l1s_com.Scell_used_IL_dd.lna_off * l1ctl_get_lna_att(radio_freq);
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2636 }
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2637
73 af1bacf61dc6 src/cs/layer1/cfile/l1_ctl.c: fix for typo made during reconstruction Mychaela Falconia <falcon@freecalypso.org> parents: 69 diff changeset	2638 #if (RF_FAM == 61) && (CODE_VERSION != SIMULATION)
69 50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2639 #if (L1_FF_MULTIBAND == 0)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2640 arfcn = Convert_l1_radio_freq(radio_freq);
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2641 #else
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2642 arfcn = radio_freq;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2643 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2644 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2645
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2646 #if(RF_FAM == 61)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2647 #if (CODE_VERSION != SIMULATION)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2648
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2649 cust_get_if_dco_ctl_algo(&dco_algo_ctl_pw_temp, &if_ctl, (UWORD8) L1_IL_VALID ,
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2650 l1a_l1s_com.Scell_used_IL_dd.input_level,
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2651 radio_freq,if_threshold);
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2652 lna_off = l1a_l1s_com.Scell_used_IL_dd.lna_off;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2653 delta_drp_gain = drp_gain_correction(arfcn, lna_off, last_known_agc); // F7.1 format
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2654 if(if_ctl == IF_100KHZ_DSP){
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2655 delta_drp_gain += SCF_ATTENUATION_LIF_100KHZ;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2656 }
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2657 else{ /* i.e. if_ctl = IF_120KHZ_DSP*/
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2658 delta_drp_gain += SCF_ATTENUATION_LIF_120KHZ;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2659 }
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2660
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2661 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2662 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2663
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2664 if (0==pm) // Check and filter illegal pm value by using last valid IL
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2665 new_IL = IL_info_ptr->input_level - lna_value;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2666 else
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2667 new_IL = -(pm - (last_known_agc - delta_drp_gain) + lna_value - l1ctl_get_g_magic(radio_freq));
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2668
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2669 current_calibrated_IL = new_IL - delta1_freq - delta2_freq;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2670
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2671 // Protect IL stores against overflow
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2672 if (current_calibrated_IL>INDEX_MAX)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2673 current_calibrated_IL=INDEX_MAX;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2674
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2675 #if TESTMODE
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2676 if (l1tm.tmode_state.dedicated_active) // Implies l1_config.TestMode = 1
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2677 {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2678 // Update l1tm.tmode_stats.rssi_fifo (delay line from index 3 to 0)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2679 for (i=(sizeof(l1tm.tmode_stats.rssi_fifo)/sizeof(l1tm.tmode_stats.rssi_fifo[0]))-1; i>0; i--)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2680 {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2681 l1tm.tmode_stats.rssi_fifo[i] = l1tm.tmode_stats.rssi_fifo[i-1];
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2682 }
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2683 l1tm.tmode_stats.rssi_fifo[0] = current_calibrated_IL; // rssi value is F7.1
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2684 l1tm.tmode_stats.rssi_recent = current_calibrated_IL; // rssi value is F7.1
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2685 }
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2686 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2687
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2688 if (new_IL>INDEX_MAX)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2689 new_IL=INDEX_MAX;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2690
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2691 tab_ptr[0] = (UWORD8)new_IL;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2692
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2693 if (dtx_on && !beacon)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2694 {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2695 // Update DTX fifo
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2696 for (i=DPAGC_FIFO_LEN-1;i>0;i--)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2697 aset->G_DTX[i]=aset->G_DTX[i-1];
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2698
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2699 aset->G_DTX[0]=tab_ptr[0];
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2700 }
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2701
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2702 /* Computation of MAX{G_all[i],G_DTX[j]} i,j=0..3 */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2703 #if DPAGC_MAX_FLAG
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2704 max_G_all = l1ctl_find_max(&(tab_ptr[0]),DPAGC_FIFO_LEN);
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2705
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2706 if (!beacon)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2707 {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2708 max_G_DTX = l1ctl_find_max(&(aset->G_DTX[0]),DPAGC_FIFO_LEN);
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2709
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2710 // WARNING: for array index purpose we work with POSITIVE input level
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2711 // so maximum search for negative numbers is equivalent to
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2712 // minimum search for positive numbers!!!!!!
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2713 // (-30 > -120 but 30 < 120)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2714 if (max_G_all <= max_G_DTX)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2715 new_IL = max_G_all;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2716 else
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2717 new_IL = max_G_DTX;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2718 }
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2719 else
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2720 new_IL = max_G_all;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2721 #else
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2722 av_G_all=av_G_DTX=0;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2723
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2724 for (i=0;i<DPAGC_FIFO_LEN;i++)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2725 av_G_all += tab_ptr[i];
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2726
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2727 av_G_all /= DPAGC_FIFO_LEN;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2728
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2729 if (!beacon)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2730 {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2731 for (i=0;i<DPAGC_FIFO_LEN;i++)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2732 av_G_DTX += aset->G_DTX[i];
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2733
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2734 av_G_DTX /= DPAGC_FIFO_LEN;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2735
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2736 if (av_G_all >= av_G_DTX)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2737 new_IL = av_G_all;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2738 else
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2739 new_IL = av_G_DTX;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2740 }
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2741 else
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2742 new_IL = av_G_all;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2743 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2744
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2745 // Updating of input_level and lna_off fields in order to correctly
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2746 // setting the AGC for the next task.
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2747 // input_level is always store with lna_on
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2748 l1ctl_encode_lna( (UWORD8)(current_calibrated_IL>>1),
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2749 &(IL_info_ptr->lna_off),
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2750 radio_freq );
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2751
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2752 IL_info_ptr->input_level = (UWORD8)new_IL + l1ctl_get_lna_att(radio_freq) *
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2753 IL_info_ptr->lna_off;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2754
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2755 #if L2_L3_SIMUL
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2756 #if (DEBUG_TRACE==BUFFER_TRACE_DPAGC)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2757 buffer_trace(4,IL_info_ptr->input_level,last_known_agc,
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2758 l1a_l1s_com.Scell_used_IL_dd.input_level,Cust_get_agc_from_IL(radio_freq, new_IL >> 1, MAX_ID));
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2759 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2760 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2761
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2762 return((UWORD8)current_calibrated_IL);
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2763 }
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2764
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2765 #if (AMR == 1)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2766 /-------------------------------------------------------/
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2767 /* l1ctl_dpagc_amr() */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2768 /-------------------------------------------------------/
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2769 /* Description : */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2770 /* =========== */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2771 /* Based on the same principle as the one used for DPAGC */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2772 /* algorithm except that the way to feed the G_dtx is */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2773 /* different */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2774 /-------------------------------------------------------/
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2775 UWORD8 l1ctl_dpagc_amr(BOOL dtx_on, BOOL beacon, UWORD8 pm, UWORD16 radio_freq, T_INPUT_LEVEL *IL_info_ptr)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2776 {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2777 UWORD8 av_G_all, av_G_DTX;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2778 UWORD8 max_G_all, max_G_DTX, max_il;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2779 WORD32 last_known_agc, new_IL, current_calibrated_IL;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2780 WORD8 delta1_freq, delta2_freq;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2781 WORD16 delta_drp_gain=0;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2782 UWORD8 i;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2783 UWORD8 tab_ptr, tab_amr_ptr;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2784 T_DEDIC_SET *aset;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2785 WORD32 lna_value;
73 af1bacf61dc6 src/cs/layer1/cfile/l1_ctl.c: fix for typo made during reconstruction Mychaela Falconia <falcon@freecalypso.org> parents: 69 diff changeset	2786 #if (RF_FAM == 61) && (CODE_VERSION != SIMULATION)
69 50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2787 UWORD16 arfcn;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2788 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2789 UWORD8 lna_off;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2790 UWORD16 dco_algo_ctl_pw_temp = 0;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2791 UWORD8 if_ctl = 0;
73 af1bacf61dc6 src/cs/layer1/cfile/l1_ctl.c: fix for typo made during reconstruction Mychaela Falconia <falcon@freecalypso.org> parents: 69 diff changeset	2792 #if (RF_FAM == 61) && (CODE_VERSION != SIMULATION)
69 50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2793 UWORD8 if_threshold = C_IF_ZERO_LOW_THRESHOLD_GSM;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2794 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2795
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2796 delta1_freq = l1ctl_encode_delta1(radio_freq);
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2797 delta2_freq = l1ctl_encode_delta2(radio_freq);
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2798
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2799 aset = l1a_l1s_com.dedic_set.aset;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2800
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2801 if (beacon)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2802 tab_ptr = l1a_l1s_com.Scell_info.buff_beacon;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2803 else
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2804 tab_ptr = aset->G_all;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2805
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2806 // Update fifo
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2807 for (i=DPAGC_FIFO_LEN-1;i>0;i--)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2808 tab_ptr[i]=tab_ptr[i-1];
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2809
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2810 tab_amr_ptr = aset->G_amr;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2811 for (i=DPAGC_AMR_FIFO_LEN-1;i>0;i--)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2812 tab_amr_ptr[i]=tab_amr_ptr[i-1];
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2813
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2814 #if TESTMODE
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2815 if (!l1_config.agc_enable)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2816 {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2817 // AGC gain can only be controlled in 2dB steps as the bottom bit (bit zero)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2818 // corresponds to the lna_off bit
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2819 last_known_agc = (l1_config.tmode.rx_params.agc) << 1;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2820 lna_value = (l1_config.tmode.rx_params.lna_off) * l1ctl_get_lna_att(radio_freq);
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2821 }
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2822 else
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2823 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2824 {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2825 #if DPAGC_MAX_FLAG
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2826 last_known_agc = (Cust_get_agc_from_IL(radio_freq, l1a_l1s_com.Scell_used_IL_dd.input_level >> 1, MAX_ID)) << 1;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2827 // F7.1 in order to be compatible with pm and IL formats
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2828 #else
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2829 last_known_agc = (Cust_get_agc_from_IL(radio_freq, l1a_l1s_com.Scell_used_IL_dd.input_level >> 1, AV_ID)) << 1;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2830 // F7.1 in order to be compatible with pm and IL formats
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2831 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2832 // input_level_dd : contain the input_level value we use
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2833 // in the associated CTL task to build the agc used in this CTL.
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2834
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2835 lna_value = l1a_l1s_com.Scell_used_IL_dd.lna_off * l1ctl_get_lna_att(radio_freq);
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2836 }
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2837
73 af1bacf61dc6 src/cs/layer1/cfile/l1_ctl.c: fix for typo made during reconstruction Mychaela Falconia <falcon@freecalypso.org> parents: 69 diff changeset	2838 #if (RF_FAM == 61) && (CODE_VERSION != SIMULATION)
69 50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2839 #if (L1_FF_MULTIBAND == 0)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2840 arfcn = Convert_l1_radio_freq(radio_freq);
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2841 #else
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2842 arfcn = radio_freq;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2843 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2844 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2845
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2846 #if(RF_FAM == 61)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2847 #if (CODE_VERSION != SIMULATION)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2848 cust_get_if_dco_ctl_algo(&dco_algo_ctl_pw_temp, &if_ctl, (UWORD8) L1_IL_VALID ,
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2849 l1a_l1s_com.Scell_used_IL_dd.input_level,
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2850 radio_freq,if_threshold);
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2851 lna_off = l1a_l1s_com.Scell_used_IL_dd.lna_off;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2852 delta_drp_gain = drp_gain_correction(arfcn, lna_off, last_known_agc); // F7.1 format
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2853 if(if_ctl == IF_100KHZ_DSP){
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2854 delta_drp_gain += SCF_ATTENUATION_LIF_100KHZ;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2855 }
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2856 else{ /* i.e. if_ctl = IF_120KHZ_DSP*/
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2857 delta_drp_gain += SCF_ATTENUATION_LIF_120KHZ;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2858 }
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2859 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2860 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2861
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2862 if (0==pm) // Check and filter illegal pm value by using last valid IL
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2863 new_IL = IL_info_ptr->input_level - lna_value;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2864 else
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2865 new_IL = -(pm - (last_known_agc - delta_drp_gain) + lna_value - l1ctl_get_g_magic(radio_freq));
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2866
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2867 current_calibrated_IL = new_IL - delta1_freq - delta2_freq;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2868
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2869 // Protect IL stores against overflow
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2870 if (current_calibrated_IL>INDEX_MAX)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2871 current_calibrated_IL=INDEX_MAX;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2872
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2873 #if TESTMODE
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2874 if (l1tm.tmode_state.dedicated_active) // Implies l1_config.TestMode = 1
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2875 {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2876 // Update l1tm.tmode_stats.rssi_fifo (delay line from index 3 to 0)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2877 for (i=(sizeof(l1tm.tmode_stats.rssi_fifo)/sizeof(l1tm.tmode_stats.rssi_fifo[0]))-1; i>0; i--)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2878 {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2879 l1tm.tmode_stats.rssi_fifo[i] = l1tm.tmode_stats.rssi_fifo[i-1];
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2880 }
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2881 l1tm.tmode_stats.rssi_fifo[0] = current_calibrated_IL; // rssi value is F7.1
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2882 l1tm.tmode_stats.rssi_recent = current_calibrated_IL; // rssi value is F7.1
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2883 }
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2884 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2885
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2886 if (new_IL>INDEX_MAX)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2887 new_IL=INDEX_MAX;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2888
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2889 tab_ptr[0] = (UWORD8)new_IL;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2890 tab_amr_ptr[0] = (UWORD8)new_IL;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2891
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2892 if (dtx_on && !beacon)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2893 {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2894 // a new AMR block is received, feed the G_dtx with the max_il of the block
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2895 for (i=DPAGC_FIFO_LEN-1;i>0;i--)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2896 aset->G_DTX[i]=aset->G_DTX[i-1];
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2897
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2898 if (l1a_l1s_com.dedic_set.aset->achan_ptr->mode == TCH_AHS_MODE)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2899 {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2900 // Keep the max_il between the last 2 bursts
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2901 if (aset->G_amr[0] > aset->G_amr[1])
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2902 max_il = aset->G_amr[0];
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2903 else
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2904 max_il = aset->G_amr[1];
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2905 }
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2906 else
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2907 {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2908 // Keep the max_il between the last 4 bursts
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2909 max_il = l1ctl_find_max(&aset->G_amr[0], DPAGC_AMR_FIFO_LEN);
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2910 }
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2911
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2912 aset->G_DTX[0]= max_il;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2913 }
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2914
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2915 /* Computation of MAX{G_all[i],G_DTX[j]} i,j=0..3 */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2916 #if DPAGC_MAX_FLAG
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2917 max_G_all = l1ctl_find_max(&(tab_ptr[0]),DPAGC_FIFO_LEN);
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2918
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2919 if (!beacon)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2920 {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2921 max_G_DTX = l1ctl_find_max(&(aset->G_DTX[0]),DPAGC_FIFO_LEN);
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2922
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2923 // WARNING: for array index purpose we work with POSITIVE input level
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2924 // so maximum search for negative numbers is equivalent to
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2925 // minimum search for positive numbers!!!!!!
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2926 // (-30 > -120 but 30 < 120)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2927 if (max_G_all <= max_G_DTX)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2928 new_IL = max_G_all;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2929 else
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2930 new_IL = max_G_DTX;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2931 }
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2932 else
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2933 new_IL = max_G_all;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2934 #else
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2935 av_G_all=av_G_DTX=0;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2936
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2937 for (i=0;i<DPAGC_FIFO_LEN;i++)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2938 av_G_all += tab_ptr[i];
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2939
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2940 av_G_all /= DPAGC_FIFO_LEN;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2941
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2942 if (!beacon)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2943 {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2944 for (i=0;i<DPAGC_FIFO_LEN;i++)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2945 av_G_DTX += aset->G_DTX[i];
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2946
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2947 av_G_DTX /= DPAGC_FIFO_LEN;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2948
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2949 if (av_G_all >= av_G_DTX)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2950 new_IL = av_G_all;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2951 else
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2952 new_IL = av_G_DTX;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2953 }
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2954 else
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2955 new_IL = av_G_all;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2956 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2957
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2958 // Updating of input_level and lna_off fields in order to correctly
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2959 // setting the AGC for the next task.
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2960 // input_level is always store with lna_on
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2961
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2962 l1ctl_encode_lna( (UWORD8)(current_calibrated_IL>>1),
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2963 &(IL_info_ptr->lna_off),
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2964 radio_freq );
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2965 IL_info_ptr->input_level = (UWORD8)new_IL + l1ctl_get_lna_att(radio_freq) *
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2966 IL_info_ptr->lna_off;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2967
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2968 #if L2_L3_SIMUL
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2969 #if (DEBUG_TRACE==BUFFER_TRACE_DPAGC)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2970 buffer_trace(4,IL_info_ptr->input_level,last_known_agc,
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2971 l1a_l1s_com.Scell_used_IL_dd.input_level,Cust_get_agc_from_IL(radio_freq, new_IL >> 1, MAX_ID));
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2972 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2973 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2974
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2975 return((UWORD8)current_calibrated_IL);
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2976 }
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2977 #endif // AMR == 1
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2978
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2979 /-------------------------------------------------------/
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2980 /* l1ctl_get_g_magic() */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2981 /-------------------------------------------------------/
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2982 /* Parameters : */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2983 /* Return : */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2984 /* Functionality : */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2985 /-------------------------------------------------------/
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2986 #if (L1_FF_MULTIBAND == 0)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2987 UWORD16 l1ctl_get_g_magic(UWORD16 radio_freq)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2988 {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2989
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2990
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2991 if ((l1_config.std.id == DUAL) \|\| (l1_config.std.id == DUALEXT) \|\| (l1_config.std.id == DUAL_US))
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2992 {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2993 if (radio_freq >= l1_config.std.first_radio_freq_band2)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2994 return(l1_config.std.g_magic_band2);
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2995 else
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2996 return(l1_config.std.g_magic_band1);
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2997 }
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2998 else
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2999 return(l1_config.std.g_magic_band1);
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	3000
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	3001
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	3002 }
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	3003 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	3004
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	3005 /-------------------------------------------------------/
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	3006 /* l1ctl_get_lna_att() */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	3007 /-------------------------------------------------------/
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	3008 /* Parameters : */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	3009 /* Return : */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	3010 /* Functionality : */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	3011 /-------------------------------------------------------/
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	3012 #if (L1_FF_MULTIBAND == 0)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	3013 UWORD16 l1ctl_get_lna_att(UWORD16 radio_freq)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	3014 {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	3015
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	3016
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	3017 if ((l1_config.std.id == DUAL) \|\| (l1_config.std.id == DUALEXT) \|\| (l1_config.std.id == DUAL_US))
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	3018 {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	3019 if (radio_freq >= l1_config.std.first_radio_freq_band2)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	3020 return(l1_config.std.lna_att_band2);
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	3021 else
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	3022 return(l1_config.std.lna_att_band1);
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	3023 }
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	3024 else
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	3025 return(l1_config.std.lna_att_band1);
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	3026
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	3027
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	3028 }
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	3029 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	3030 /-------------------------------------------------------/
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	3031 /* l1ctl_update_TPU_with_toa() */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	3032 /-------------------------------------------------------/
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	3033 /* Parameters : */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	3034 /* Return : */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	3035 /* Functionality : */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	3036 /-------------------------------------------------------/
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	3037 void l1ctl_update_TPU_with_toa(void)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	3038 {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	3039 #if (TOA_ALGO != 0)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	3040 WORD16 toa_shift;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	3041
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	3042 #if (TOA_ALGO == 2)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	3043 toa_shift = l1s.toa_var.toa_shift;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	3044 #else
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	3045 toa_shift = l1s.toa_shift;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	3046 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	3047
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	3048 if (toa_shift != ISH_INVALID)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	3049 // New ISH (TOA shift) has been stored in "l1s.toa_shift".
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	3050 {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	3051 // NEW !!! For EOTD measurements in IDLE mode, cut AFC updates...
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	3052 #if (L1_EOTD==1)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	3053 #if (L1_GPRS)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	3054 if ( (l1a_l1s_com.nsync.eotd_meas_session == FALSE) \|\|
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	3055 (l1a_l1s_com.mode == DEDIC_MODE)\|\|
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	3056 (l1a_l1s_com.l1s_en_task[PDTCH] == TASK_ENABLED))
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	3057 #else
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	3058 if ( (l1a_l1s_com.nsync.eotd_meas_session == FALSE) \|\|
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	3059 (l1a_l1s_com.mode == DEDIC_MODE))
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	3060 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	3061 {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	3062 // In dedicated or transfer modes we need to track an TOA
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	3063 // updates to post correct th results, else E-OTD implementation
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	3064 // has qb errors...
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	3065
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	3066 if( (l1a_l1s_com.nsync.eotd_meas_session == TRUE)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	3067 && (l1a_l1s_com.nsync.eotd_toa_phase == 1) )
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	3068 {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	3069 l1a_l1s_com.nsync.eotd_toa_tracking += toa_shift;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	3070 }
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	3071 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	3072 // Update tpu offset.
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	3073 l1s.tpu_offset = (l1s.tpu_offset + TPU_CLOCK_RANGE + toa_shift) % TPU_CLOCK_RANGE;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	3074
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	3075 #if (TRACE_TYPE==1) \|\| (TRACE_TYPE==4)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	3076 #if (GSM_IDLE_RAM == 0)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	3077 l1_trace_new_toa();
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	3078 #else
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	3079 l1_trace_new_toa_intram();
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	3080 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	3081 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	3082
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	3083 #if (L1_EOTD==1)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	3084 }
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	3085 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	3086
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	3087 #if (TRACE_TYPE == 5)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	3088 #if (TOA_ALGO == 2)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	3089 trace_toa_sim_update (toa_shift,l1s.tpu_offset);
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	3090 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	3091 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	3092
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	3093 // Reset ISH.
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	3094 #if (TOA_ALGO == 2)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	3095 l1s.toa_var.toa_shift = ISH_INVALID; // Reset the ISH.
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	3096 #else
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	3097 l1s.toa_shift = ISH_INVALID; // Reset the ISH.
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	3098 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	3099 }
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	3100 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	3101 }
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	3102
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	3103
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	3104 /-------------------------------------------------------/
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	3105 /* l1ctl_saic() */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	3106 /-------------------------------------------------------/
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	3107 /* Parameters : */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	3108 /* Return : */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	3109 /* Functionality : */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	3110 /-------------------------------------------------------/
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	3111
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	3112 #if (L1_SAIC != 0)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	3113 #define SWH_CHANTAP_INIT 0xFFD068CE
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	3114 #if (NEW_SNR_THRESHOLD == 1)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	3115 UWORD8 l1ctl_saic (UWORD8 IL_for_rxlev, UWORD32 l1_mode, UWORD8 task, UWORD8 * saic_flag)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	3116 #else
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	3117 UWORD8 l1ctl_saic (UWORD8 IL_for_rxlev, UWORD32 l1_mode)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	3118 #endif /* NEW_SNR_THRESHOLD */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	3119 {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	3120 UWORD16 SWH_flag = 0;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	3121 UWORD8 CSF_Filter_choice = L1_SAIC_HARDWARE_FILTER;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	3122 #if (NEW_SNR_THRESHOLD == 0)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	3123 volatile UWORD16 *ptr;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	3124 UWORD8 saic_flag;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	3125 #endif /* NEW_SNR_THRESHOLD */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	3126 #if (NEW_SNR_THRESHOLD == 0)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	3127 ptr = (volatile UWORD16 * ) (SWH_CHANTAP_INIT);
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	3128 *ptr = 0;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	3129 saic_flag=1;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	3130 #else
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	3131 *saic_flag=0;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	3132 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	3133
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	3134 switch (l1_mode)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	3135 {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	3136 case DEDIC_MODE: // GSM DEDICATED MODE
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	3137 {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	3138 #if (NEW_SNR_THRESHOLD == 1)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	3139 *saic_flag=1;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	3140 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	3141 if(IL_for_rxlev < L1_SAIC_GENIE_GSM_DEDIC_THRESHOLD)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	3142 {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	3143 SWH_flag=1;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	3144 }
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	3145
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	3146 break;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	3147 }
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	3148 #if L1_GPRS
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	3149 case PACKET_TRANSFER_MODE: // PACKET TRANSFER MODE
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	3150 {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	3151 #if (NEW_SNR_THRESHOLD == 0)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	3152 #if (L1_SAIC == 1)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	3153 if(IL_for_rxlev < L1_SAIC_GENIE_GPRS_PCKT_TRAN_THRESHOLD)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	3154 {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	3155 *ptr = 4;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	3156 }
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	3157 #endif /#if (L1_SAIC == 3)/
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	3158 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	3159
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	3160 #if (L1_SAIC == 3)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	3161 if(IL_for_rxlev < L1_SAIC_GENIE_GPRS_PCKT_TRAN_THRESHOLD)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	3162 {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	3163 SWH_flag = 1;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	3164 }
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	3165 #endif /#if (L1_SAIC == 3)/
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	3166 break;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	3167 }
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	3168 #endif /#if L1_GPRS/
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	3169 default: /* GSM OR GPRS IDLE MODES */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	3170 {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	3171 #if ((L1_SAIC == 2)\|\|(L1_SAIC == 3))
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	3172 if(IL_for_rxlev < L1_SAIC_GENIE_GSM_GPRS_IDLE_THRESHOLD)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	3173 {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	3174 SWH_flag=1;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	3175 }
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	3176 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	3177 break;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	3178 }
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	3179 }
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	3180
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	3181 l1ddsp_load_swh_flag (SWH_flag ,
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	3182 #if (NEW_SNR_THRESHOLD == 0)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	3183 saic_flag
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	3184 #else
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	3185 *saic_flag
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	3186 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	3187 );
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	3188
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	3189 if(SWH_flag == 1)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	3190 {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	3191 CSF_Filter_choice = L1_SAIC_PROGRAMMABLE_FILTER;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	3192 }
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	3193
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	3194
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	3195 #if (TRACE_TYPE == 1) \|\| (TRACE_TYPE == 4)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	3196 l1_trace_saic(SWH_flag,
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	3197 #if (NEW_SNR_THRESHOLD == 0)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	3198 saic_flag
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	3199 #else
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	3200 *saic_flag
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	3201 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	3202 );
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	3203 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	3204 #if (TRACE_TYPE == 5)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	3205 trace_saic_sim(IL_for_rxlev, l1_mode, SWH_flag);
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	3206 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	3207
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	3208 return(CSF_Filter_choice);
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	3209 }
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	3210 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	3211
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	3212 #if (FF_L1_FAST_DECODING == 1)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	3213 /-----------------------------------------------------------------/
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	3214 /* l1ctl_pagc_missing_bursts */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	3215 /-----------------------------------------------------------------/
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	3216 /* */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	3217 /* Description: */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	3218 /* ------------ */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	3219 /* When fast decoding is active, fewer bursts are decoded. As a */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	3220 /* result, fewer gain values are available. The PAGC algo must */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	3221 /* be updated with the missed values. */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	3222 /* */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	3223 /* Input parameters: */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	3224 /* ----------------- */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	3225 /* UWORD8 skipped_values: the number of skipped bursts due to fast */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	3226 /* decoding. */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	3227 /* */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	3228 /* Input parameters from globals: */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	3229 /* ------------------------------ */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	3230 /* l1a_l1s_com.Scell_info.buff_beacon: Input Level (IL) FIFO */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	3231 /* l1_config.params.il_min: minimum level */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	3232 /* */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	3233 /* Output parameters: */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	3234 /* ------------------ */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	3235 /* none */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	3236 /* */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	3237 /* Modified parameters from globals: */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	3238 /* --------------------------------- */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	3239 /* l1a_l1s_com.Scell_info.buff_beacon: Input Level (IL) FIFO */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	3240 /* */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	3241 /-----------------------------------------------------------------/
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	3242
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	3243 void l1ctl_pagc_missing_bursts (UWORD8 skipped_values)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	3244 {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	3245 UWORD8 i = 0;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	3246
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	3247 /* skipped_values cannot be greater than 3, otherwise this is an error
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	3248 * and the PAGC algorithm mustn't be updated. */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	3249 if (skipped_values > 3)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	3250 {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	3251 return;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	3252 }
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	3253
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	3254 /* Update fifo by removing skipped_values of samples */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	3255 for (i = 3; i > (skipped_values - 1); i--)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	3256 {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	3257 l1a_l1s_com.Scell_info.buff_beacon[i] = l1a_l1s_com.Scell_info.buff_beacon[i-skipped_values];
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	3258 }
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	3259
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	3260 /* Insert minimum IL level as many times a burst has been skipped */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	3261 for (i = 0; i < skipped_values; i++)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	3262 {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	3263 l1a_l1s_com.Scell_info.buff_beacon[i] = l1_config.params.il_min;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	3264 }
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	3265 }
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	3266 #endif /* #if (FF_L1_FAST_DECODING == 1) */

FreeCalypso > hg > fc-magnetite

annotate src/cs/layer1/cfile/l1_ctl.c @ 640:16eb1b9640dc