tcs211-l1-reconst: chipsetsw/layer1/cfile/l1

annotate chipsetsw/layer1/cfile/l1_ctl.c @ 82:ef6cf21cf9d6

l1_ctl.c: passes compilation, but doesn't match old object yet

author	Mychaela Falconia <falcon@ivan.Harhan.ORG>
date	Tue, 29 Mar 2016 16:24:09 +0000
parents	6124f48fc1fa
children	43dd68d8d891

rev	line source
80 6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1 /*********** Revision Controle System Header ***********
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2 * GSM Layer 1 software
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	3 * L1_CTL.C
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	4 *
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	5 * Filename l1_ctl.c
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	6 * Copyright 2003 (C) Texas Instruments
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	7 *
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	8 *********** Revision Controle System Header ***********/
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	9
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	10 #define L1_CTL_C
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	11
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	12 #include "l1_macro.h"
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	13 #include "l1_confg.h"
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	14
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	15 #if (CODE_VERSION == SIMULATION)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	16 #include <string.h>
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	17 #include "l1_types.h"
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	18 #include "sys_types.h"
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	19 #include "l1_const.h"
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	20 #include "l1_time.h"
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	21 #include "l1_signa.h"
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	22
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	23 #if TESTMODE
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	24 #include "l1tm_defty.h"
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	25 #endif
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	26 #if (AUDIO_TASK == 1)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	27 #include "l1audio_const.h"
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	28 #include "l1audio_cust.h"
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	29 #include "l1audio_signa.h"
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	30 #include "l1audio_defty.h"
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	31 #include "l1audio_msgty.h"
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	32 #endif
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	33 #if (L1_GTT == 1)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	34 #include "l1gtt_const.h"
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	35 #include "l1gtt_defty.h"
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	36 #endif
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	37 #if (L1_MP3 == 1)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	38 #include "l1mp3_defty.h"
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	39 #endif
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	40 #if (L1_MIDI == 1)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	41 #include "l1midi_defty.h"
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	42 #endif
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	43 //ADDED FOR AAC
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	44 #if (L1_AAC == 1)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	45 #include "l1aac_defty.h"
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	46 #endif
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	47 #include "l1_defty.h"
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	48 #include "cust_os.h"
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	49 #include "l1_msgty.h"
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	50 #include "l1_varex.h"
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	51 #include "l1_proto.h"
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	52 #include "l1_mftab.h"
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	53 #include "l1_tabs.h"
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	54 #include "l1_ver.h"
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	55 #if L2_L3_SIMUL
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	56 #include "hw_debug.h"
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	57 #endif
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	58
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	59 #if TESTMODE
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	60 #include "l1tm_msgty.h"
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	61 #include "l1tm_varex.h"
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	62 #endif
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	63
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	64 #include "l1_ctl.h"
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	65
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	66 #ifdef _INLINE
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	67 #define INLINE static inline // Inline functions when -v option is set
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	68 #else // when the compiler is ivoked.
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	69 #define INLINE
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	70 #endif
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	71 #else
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	72 #include <string.h>
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	73 #include "l1_types.h"
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	74 #include "sys_types.h"
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	75 #include "l1_const.h"
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	76 #include "l1_time.h"
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	77 #include "l1_signa.h"
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	78
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	79 #if (RF_FAM == 61)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	80 #include "tpudrv61.h"
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	81 #endif
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	82
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	83 #if TESTMODE
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	84 #include "l1tm_defty.h"
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	85 #endif
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	86 #if (AUDIO_TASK == 1)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	87 #include "l1audio_const.h"
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	88 #include "l1audio_cust.h"
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	89 #include "l1audio_defty.h"
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	90 #endif
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	91 #if (L1_GTT == 1)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	92 #include "l1gtt_const.h"
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	93 #include "l1gtt_defty.h"
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	94 #endif
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	95 #if (L1_MP3 == 1)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	96 #include "l1mp3_defty.h"
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	97 #endif
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	98 #if (L1_MIDI == 1)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	99 #include "l1midi_defty.h"
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	100 #endif
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	101 //ADDED FOR AAC
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	102 #if (L1_AAC == 1)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	103 #include "l1aac_defty.h"
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	104 #endif
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	105 #include "l1_defty.h"
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	106 #include "cust_os.h"
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	107 #include "l1_msgty.h"
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	108 #include "l1_varex.h"
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	109 #include "l1_proto.h"
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	110 #include "l1_tabs.h"
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	111 #include "l1_ctl.h"
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	112 #if L2_L3_SIMUL
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	113 #include "hw_debug.h"
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	114 #endif
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	115
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	116 #if TESTMODE
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	117 #include "l1tm_msgty.h"
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	118 #include "l1tm_varex.h"
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	119 #endif
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	120 #ifdef _INLINE
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	121 #define INLINE static inline // Inline functions when -v option is set
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	122 #else // when the compiler is ivoked.
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	123 #define INLINE
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	124 #endif
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	125 #endif
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	126
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	127 #if(RF_FAM == 61)
81 6124f48fc1fa l1_ctl.c: fixes from the freecalypso-sw/gsm-fw version Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 80 diff changeset	128 #include "l1_rf61.h"
80 6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	129 #endif
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	130
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	131 #if (TRACE_TYPE == 1) \|\| (TRACE_TYPE == 4)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	132 #include "l1_trace.h"
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	133 #endif
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	134
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	135 extern SYS_UWORD16 Convert_l1_radio_freq(SYS_UWORD16 radio_freq);
81 6124f48fc1fa l1_ctl.c: fixes from the freecalypso-sw/gsm-fw version Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 80 diff changeset	136 #if(RF_FAM == 61)
80 6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	137 extern WORD16 drp_gain_correction(UWORD16 arfcn, UWORD8 lna_off, UWORD16 agc);
81 6124f48fc1fa l1_ctl.c: fixes from the freecalypso-sw/gsm-fw version Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 80 diff changeset	138 #endif
80 6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	139
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	140 #define LNA_OFF 1
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	141 #define LNA_ON 0
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	142
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	143
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	144
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	145
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	146 /************************************/
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	147 /* Automatic frequency compensation */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	148 /************************************/
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	149
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	150 #define L1_WORD16_POS_MAX (32767)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	151 #define L1_WORD16_NEG_MAX (-32768)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	152 #define L1_WORD32_POS_MAX ((unsigned long)(1<<31)-1)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	153 #define L1_WORD32_NEG_MAX (-(unsigned long)(1<<31))
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	154
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	155 INLINE WORD16 Add_Sat_sign_16b(WORD16 val1, WORD16 val2)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	156 {
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	157 WORD32 temp;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	158 WORD16 result;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	159
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	160 temp = (WORD32)((WORD32)val1 + (WORD32)val2);
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	161 if(temp > L1_WORD16_POS_MAX)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	162 {
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	163 temp = L1_WORD16_POS_MAX;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	164 }
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	165 if(temp < L1_WORD16_NEG_MAX)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	166 {
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	167 temp = L1_WORD16_NEG_MAX;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	168 }
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	169 result = (WORD16)((temp)&(0x0000FFFF));
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	170 return(result);
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	171 }
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	172
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	173 INLINE WORD32 Add_Sat_sign_32b(WORD32 val1, WORD32 val2)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	174 {
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	175 WORD32 temp_high_high;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	176 UWORD32 temp_low_low;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	177 UWORD16 carry;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	178 WORD32 result;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	179 WORD16 high_val1, high_val2;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	180 UWORD16 low_val1, low_val2;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	181
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	182 high_val1 = (WORD16)(val1>>16);
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	183 high_val2 = (WORD16)(val2>>16);
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	184 low_val1 = (UWORD16)(val1&0x0000FFFF);
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	185 low_val2 = (UWORD16)(val2&0x0000FFFF);
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	186
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	187 temp_high_high = (WORD32)high_val1 + (WORD32)high_val2;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	188 temp_low_low = (UWORD32)low_val1 + (UWORD32)low_val2;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	189 carry = (UWORD16)(temp_low_low >> 16);
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	190 temp_high_high = temp_high_high + (UWORD32)(carry);
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	191
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	192
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	193 result = val1 + val2;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	194 if(temp_high_high > L1_WORD16_POS_MAX)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	195 {
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	196 result = L1_WORD32_POS_MAX;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	197 }
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	198 if(temp_high_high < L1_WORD16_NEG_MAX)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	199 {
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	200 result = L1_WORD32_NEG_MAX;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	201 }
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	202
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	203 return(result);
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	204 }
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	205
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	206 INLINE WORD32 Sat_Mult_20sign_16unsign(WORD32 val1, UWORD32 val2)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	207 {
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	208 WORD32 result;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	209
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	210 result = val1 * val2;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	211 if(val1>0) /* val2 is > 0*/
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	212 {
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	213 if(result < 0) /* overflow */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	214 {
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	215 result = L1_WORD32_POS_MAX;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	216 }
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	217 }
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	218 if(val1<0) /* val2 is > 0*/
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	219 {
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	220 if(result > 0) /* overflow */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	221 {
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	222 result = L1_WORD32_NEG_MAX;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	223 }
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	224 }
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	225 return(result);
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	226 }
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	227
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	228
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	229 INLINE WORD32 Add_40b( WORD32 guard1guard2, WORD32 lvar1, WORD32 lvar2, WORD16 *guardout )
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	230 {
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	231 WORD32 result, temp, carry, Lvar1, Lvar2;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	232 WORD16 guard1,guard2;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	233
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	234 guard1=(WORD16) ((WORD32) guard1guard2>>16);
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	235 guard2=(WORD16) guard1guard2;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	236
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	237 /* lvar1 and lvar2 are both 48 bits variables */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	238 /* We 1st add the low parts of lvar1 and lvar2 and we give */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	239 /* a 32 bits result and a carry if needed */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	240 Lvar1 = (UWORD16)lvar1;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	241 Lvar2 = (UWORD16)lvar2;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	242
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	243 temp = Lvar1 + Lvar2;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	244
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	245 carry = temp >> 16;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	246
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	247 result = temp & 0x0000ffffL;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	248
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	249 /* We now add the two high parts of var1 and var2 (scaled */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	250 /* to a 16 bits format) and carry (if any) and we give a */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	251 /* 48 bits results. */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	252 Lvar1 = (UWORD32)lvar1 >> 16;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	253 Lvar2 = (UWORD32)lvar2 >> 16;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	254
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	255 temp = Lvar1 + Lvar2 + carry;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	256
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	257 carry = (UWORD32)temp >> 16;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	258
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	259 temp = (UWORD32)temp << 16;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	260
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	261 result = result \| temp;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	262
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	263 temp = guard1 + guard2 + carry;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	264
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	265 *guardout = (WORD16)temp;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	266
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	267 return( result );
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	268 }
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	269
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	270
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	271 INLINE WORD32 Mult_40b(WORD32 var1, WORD16 var2, WORD16 *guardout)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	272 {
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	273 WORD32 mult,guard1guard2;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	274 WORD32 aux1;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	275 UWORD32 aux2;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	276 WORD16 neg_flag=0;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	277 WORD32 var1_low_nosign,var2_nosign;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	278
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	279 if (var2<0)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	280 {
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	281 var2=-var2;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	282 neg_flag=1;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	283 }
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	284
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	285 /aux1 = AccHigh(var1)var2 */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	286 aux1 = (WORD32)(var1>>16) * (WORD32)var2;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	287 /* 16 bits * 16 bits -> 32 bits result */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	288
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	289 /aux2 = AccLow(var1)var2 (unsigned multiplication) */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	290 /* Performs the sign suppression of the words */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	291 var1_low_nosign = (UWORD16)var1;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	292 var2_nosign = (UWORD16) var2;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	293
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	294 aux2 = (UWORD32)var1_low_nosign * (UWORD32)var2_nosign;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	295
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	296 /Shift aux1=F48 of 16 bit left /
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	297 guard1guard2=aux1&0xFFFF0000L;/guard1=(WORD16)(aux1>>16)/
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	298 /guard2=0x0000 /
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	299 aux1=aux1<<16;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	300
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	301
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	302 /* ((var1_highvar2)<<16) +(var1_lowvar2) = aux1 + aux2 */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	303 /* aux1 and aux2 are both 48 bits variables */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	304 /* We first add the low pats of aux1 and aux2 and we give*/
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	305 /* a 32 bits result and a carry if needed */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	306 mult=Add_40b(guard1guard2,aux1,aux2,guardout );
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	307
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	308 if (neg_flag)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	309 {
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	310 mult=-mult;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	311 if (*guardout!=0)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	312 guardout=-(guardout)-1;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	313 else
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	314 *guardout=-1;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	315 }
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	316
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	317 return(mult);
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	318 }
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	319
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	320
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	321 /***********************************************************************/
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	322 /* This function allows to multiply a WORD32 and a WORD16, both POSITIVE, */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	323 /* variables. Result is WORD32. */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	324 /***********************************************************************/
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	325 INLINE WORD32 UMult_40b(WORD32 var1, WORD16 var2, WORD16 *guardout)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	326 {
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	327 WORD32 mult,guard1guard2;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	328 UWORD32 aux1,aux2;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	329 WORD32 var1_high_nosign,var1_low_nosign,var2_nosign;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	330
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	331
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	332 /aux1 = AccHigh(var1)var2 (unsigned multiplication) */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	333 /* Performs the sign suppression of the words */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	334 var1_high_nosign = (UWORD32)var1>>16;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	335 var2_nosign = (UWORD16) var2;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	336
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	337 aux1 = (UWORD32)var1_high_nosign * (UWORD32)var2_nosign;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	338
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	339 /aux2 = AccLow(var1)var2 (unsigned multiplication) */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	340 /* Performs the sign suppression of the words */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	341 var1_low_nosign = (WORD32)((UWORD16)var1);
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	342
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	343 aux2 = (UWORD32)var1_low_nosign * (UWORD32)var2_nosign;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	344
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	345 /Shift aux1=F48 of 16 bit left /
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	346 guard1guard2=aux1&0xFFFF0000L;/guard1=(WORD16)(aux1>>16)/
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	347 /guard2=0x0000 /
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	348 aux1=aux1<<16;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	349
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	350
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	351 /* ((var1_highvar2)<<16) +(var1_lowvar2) = aux1 + aux2 */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	352 mult=Add_40b(guard1guard2,aux1,aux2,guardout);
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	353
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	354 return(mult);
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	355 }
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	356
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	357
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	358 /-------------------------------------------------------/
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	359 /* l1ctl_afc() */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	360 /-------------------------------------------------------/
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	361 /* Parameters : */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	362 /* Return : */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	363 /* Functionality : */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	364 /-------------------------------------------------------/
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	365 #if (VCXO_ALGO == 0)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	366 WORD16 l1ctl_afc (UWORD8 phase, UWORD32 *frame_count, WORD16 angle, WORD32 snr, UWORD16 radio_freq)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	367 #else
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	368 WORD16 l1ctl_afc (UWORD8 phase, UWORD32 *frame_count, WORD16 angle, WORD32 snr, UWORD16 radio_freq, UWORD32 l1_mode)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	369 #endif
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	370 {
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	371 /*************************/
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	372 /* Variables declaration */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	373 /*************************/
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	374 WORD16 i=0;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	375 UWORD32 denom; /* F12.20 */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	376 WORD32 var_32,num,Phi_32=0,var1,var2,guard1guard2;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	377 static UWORD32 P=C_cov_start; /* F12.20 */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	378 static WORD32 Psi=0; /* F13.19 */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	379 static WORD16 Psi_quant[C_N_del+1]; /* F13.3 */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	380 WORD16 var_16;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	381 WORD16 Phi=0; /* F1.15 */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	382 WORD16 quotient,guard1,guard2,guardout;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	383 UWORD32 LGuard;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	384 WORD16 denomH,denomH_3msb;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	385 UWORD32 K=0; /* algo 1 */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	386
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	387 static WORD16 old_Psi_quant[C_N_del+1];
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	388 static WORD32 old_Psi=0;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	389
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	390 #if (VCXO_ALGO == 1)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	391 static WORD32 psi_past[C_N_del+1]; /* F13.19 */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	392 static WORD16 psi_quant; /* F13.3 */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	393 static WORD16 quant_avg;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	394 static UWORD32 M_Count;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	395 static WORD32 psi_avg[C_PSI_AVG_SIZE_D+1]; // Data history array
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	396 static WORD16 B_Count; // Counter for consecutive SNR below C_thr_snr
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	397 UWORD16 L = 10433; // Gain algo2
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	398 static UWORD16 first_avg;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	399 static UWORD16 good_snr;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	400
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	401 /* to be able to keep in memory the old AFC variables in case of spurious
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	402 FB detection */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	403 static WORD32 old_psi_past[C_N_del+1]; /* F13.19 */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	404 static WORD16 old_psi_quant; /* F13.3 */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	405
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	406 #endif
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	407 #if (L1_FF_MULTIBAND == 1)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	408 UWORD8 physical_band_id;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	409 #endif
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	410
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	411
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	412 //Set AFC close loop gain for ALGO_AFC_LQG_PREDICTOR.
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	413 if(l1_mode==I_MODE)//MS is in Idle mode
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	414 L = 41732; //F0.20 L=41732/2^20 = 0.04
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	415 else //All other modes than Idle
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	416 L = 10433; //F0.20 L=10433/2^20 = 0.01
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	417
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	418
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	419 #if (L1_FF_MULTIBAND == 0)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	420
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	421 if (((l1_config.std.id == DUAL) \|\| (l1_config.std.id == DUALEXT) \|\| (l1_config.std.id == DUAL_US)) &&
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	422 #if (VCXO_ALGO == 1)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	423 ((phase != AFC_INIT_CENTER) \|\| (phase != AFC_INIT_MIN) \|\| (phase != AFC_INIT_MAX)))
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	424 #else
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	425 (phase != AFC_INIT))
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	426 #endif
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	427 {
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	428 if (radio_freq >= l1_config.std.first_radio_freq_band2)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	429 {
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	430 angle = (angle + 1) >> 1;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	431 }
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	432 }
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	433
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	434 else if (((l1_config.std.id == DCS1800) \|\| (l1_config.std.id == PCS1900)) &&
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	435 #if (VCXO_ALGO == 1)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	436 ((phase != AFC_INIT_CENTER) \|\| (phase != AFC_INIT_MIN) \|\| (phase != AFC_INIT_MAX)))
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	437 #else
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	438 (phase != AFC_INIT))
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	439 #endif
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	440 {
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	441 angle = (angle + 1) >> 1;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	442 }
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	443
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	444 #else // L1_FF_MULTIBAND = 1 below
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	445
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	446 #if (VCXO_ALGO == 1)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	447 if((phase != AFC_INIT_CENTER) \|\| (phase != AFC_INIT_MIN) \|\| (phase != AFC_INIT_MAX))
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	448 #else
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	449 if(phase != AFC_INIT)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	450 #endif
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	451 {
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	452 physical_band_id = l1_multiband_radio_freq_convert_into_physical_band_id(radio_freq);
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	453
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	454 if( (multiband_rf[physical_band_id].gsm_band_identifier == DCS1800) \|\| (multiband_rf[physical_band_id].gsm_band_identifier == PCS1900))
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	455 {
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	456 angle = (angle + 1) >> 1;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	457 }
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	458 }
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	459
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	460 #endif // #if (L1_FF_MULTIBAND == 1) else
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	461
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	462
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	463
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	464 /*********************************/
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	465 /* frequency offset compensation */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	466 /*********************************/
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	467 /* Initialization */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	468
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	469 #if (VCXO_ALGO == 1)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	470 switch (l1_config.params.afc_algo)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	471 {
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	472
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	473 /* algo1 only: */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	474 case ALGO_AFC_KALMAN:
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	475 {
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	476 #endif
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	477 #if (VCXO_ALGO == 0)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	478 if (phase==AFC_INIT)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	479 {
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	480 // WARNING
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	481 // In this case, "angle" variable contains EEPROM_AFC initialization value
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	482 // directly loaded from EEPROM, and "snr" variable is not meaningful.
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	483 /* Static variables initialisation */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	484 P=C_cov_start;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	485 Psi=0;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	486 if (angle>C_max_step)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	487 Psi_quant[C_N_del]=C_max_step;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	488 else
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	489 if(angle<C_min_step)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	490 Psi_quant[C_N_del]=C_min_step;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	491 else Psi_quant[C_N_del]=angle;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	492
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	493 Psi=l1_config.params.psi_stPsi_quant[C_N_del]; / F0.16 * F13.3 = F13.19 */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	494 } /* end AFC_INIT*/
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	495 else
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	496 {
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	497 if (phase==AFC_OPEN_LOOP)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	498 {
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	499 /* delay line for Psi_quant values */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	500 for (i=1;i<=C_N_del;i++)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	501 Psi_quant[i-1]=Psi_quant[i];
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	502
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	503 var_32=(WORD32)((WORD32)angle*l1_config.params.psi_sta_inv)<<4;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	504 /(F16.0 F1.15 = F17.15) << 4 = F13.19 */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	505
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	506 #if(RF_FAM == 61)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	507 /* In order to implement the NINT function for a F16.0, we check */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	508 /* if var_32 + 0.5218 is a multiple of 218 /
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	509 quotient=(WORD16)((WORD32)(((WORD32)(var_32+(1<<17)))/(1<<18)));
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	510 var_16=quotient*4;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	511 #else
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	512 /* In order to implement the NINT function for a F16.0, we check */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	513 /* if var_32 + 0.5219 is a multiple of 219 /
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	514 quotient=(WORD16)((WORD32)(((WORD32)(var_32+(1<<18)))/(1<<19)));
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	515 var_16=quotient*8;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	516 #endif
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	517 if (var_16>C_max_step)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	518 Psi_quant[C_N_del]=Add_Sat_sign_16b(Psi_quant[C_N_del],C_max_step);
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	519 else
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	520 if(var_16<C_min_step)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	521 Psi_quant[C_N_del]=Add_Sat_sign_16b(Psi_quant[C_N_del],C_min_step);
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	522 else Psi_quant[C_N_del]=Add_Sat_sign_16b(Psi_quant[C_N_del],var_16); /* F13.3 */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	523
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	524 Psi=l1_config.params.psi_stPsi_quant[C_N_del]; / F0.16 * F13.3 = F13.19 */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	525 }/end if AFC_OPEN_LOOP/
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	526
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	527 else
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	528 {
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	529 /* delay line for Psi_quant values */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	530 for (i=1;i<=C_N_del;i++)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	531 Psi_quant[i-1]=Psi_quant[i];
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	532
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	533 /********************/
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	534 /* Filter algorithm */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	535 /********************/
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	536
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	537 /* Covariance error is increased of C_Q */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	538 P=P+(frame_count)C_Q;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	539
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	540 /* Clipping of P */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	541 if (P>C_thr_P) P=C_thr_P;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	542
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	543 if (snr>=C_thr_snr)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	544 {
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	545 /* Clipping of error angle */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	546 if (angle>C_thr_phi)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	547 angle=C_thr_phi;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	548 if (angle<-C_thr_phi)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	549 angle=-C_thr_phi;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	550
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	551 /* Kalman gain */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	552 /K=P(1/(P+C_a0_kalman+(C_g_kalmanRNS))) /
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	553 /C_a0_kalman=0.01 /
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	554 /C_g_kalman =0.05 /
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	555 num=(C_g_kalman/snr)+P+C_a0_kalman;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	556 /* (F2.30 / F6.10) = F 12.20 */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	557
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	558 /* denom = P << 19 = F 1.39 */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	559 /* extension of denom=P to a 40 bits variable */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	560 /* denom (F12.20) << 16 = F 4.36 */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	561 guard1=(WORD16)((WORD32)P>>16);
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	562 /* denom = P<<16 = (F4.36) << 3 = F 1.39 */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	563 denomH=(UWORD16)P;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	564 /* Low part of denom is equal to 0, because P has been 16 */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	565 /* bits left shifted previously. */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	566 denomH_3msb=(denomH>>13)&0x0007;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	567 guard1=(guard1<<3)\|denomH_3msb;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	568 denomH<<=3;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	569 denom=(UWORD32)denomH<<16;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	570 /* num + guard1 are a 40 bits representation of P */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	571 /* In order to compute P(F1.39)/num, we sample P in guard1 */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	572 /* (scaled to a 32 bits number) and num (32 bits number) */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	573 /* K = ((guard1<<24)/num)<<8 + (denom/num) */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	574 var1=(WORD32)guard1<<24;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	575 var1=var1/num;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	576 var1=(WORD32)var1<<8;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	577 /* var2 is an unsigned variable, var1 contains signed guard*/
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	578 /* bits. */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	579 var2=denom/num;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	580 K = (var1+var2)<<1; /* F1.39 / F12.20 = F13.19 */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	581 /* F13.19 << 1 = F12.20 */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	582
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	583 /* Clipping of the Kalman gain */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	584 if (K>=C_thr_K)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	585 K=C_thr_K;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	586
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	587 /*******************************************************/
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	588 /* P=(1-K)P = 0.8 0.5 at maximum */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	589 /*******************************************************/
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	590 /* Perform a positive variable F12.20 multiplication by*/
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	591 /* positive variable F12.20 */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	592 var_16=(WORD16)(1048576L-K); /* acclow(1-K) = F12.20 */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	593 guard1=0; /* positive variable */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	594 var1=UMult_40b(P,var_16,&guard1);
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	595 var_16=(WORD16)((1048576L-K)>>16);
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	596 /* acchigh(1-K) = F12.20 */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	597 var2=Pvar_16; / var2 = 0x80000 * 0xc */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	598 /* at maximum, so result */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	599 /* is 32 bits WORD32 and */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	600 /* equal 0x600000 */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	601 /* extension of var2 to a 40 bits variable : var2<<16 */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	602 guard2=(WORD16)((WORD32)var2>>16);
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	603 guard1guard2=((WORD32)guard1<<16) \|((WORD32) guard2&0x0000FFFFL);
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	604 var2=var2<<16;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	605 var_32=Add_40b(guard1guard2,var1,var2,&guardout);
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	606 /* var_32 (F8.40) >> 16 = F8.24 */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	607 LGuard=(WORD32)guardout<<16;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	608 var1=(UWORD32)var_32>>16;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	609 /* var_32 >> 4 = F12.20 */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	610 P=(var1+LGuard)>>4;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	611
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	612 Phi_32=Mult_40b(l1_config.params.psi_st_32,Psi_quant[0],&guardout);
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	613 /* F0.32 * F13.3 = F5.35 */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	614 LGuard=(WORD32)guardout<<16; /* var_32 (F5.35) >> 16 */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	615 /* F13.19 */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	616 var1=(UWORD32)Phi_32>>16;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	617 Phi_32=Psi-(LGuard+var1); /* F13.19 */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	618
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	619 /Phi=angle-Phi_32/
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	620 Phi_32=((WORD32)angle<<4)-Phi_32;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	621 /* F1.15 * 4 = F13.19 */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	622 Phi=(WORD16)(Phi_32>>4); /* F17.15 */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	623 /var1=KPhi F12.20 * F1.15 = 13.35 */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	624 guard1=0;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	625 var1=Mult_40b(K,Phi,&guard1);
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	626 /* var1 (F13.35) >> 16 */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	627 /* F13.19 */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	628 LGuard=(WORD32)guard1<<16;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	629 var1=(UWORD32)var1>>16;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	630 Psi+=var1+LGuard;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	631 }/if snr /
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	632
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	633 var_32=Mult_40b(Psi,l1_config.params.psi_st_inv,&guardout);
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	634 /* F13.19 * C = F13.19 */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	635
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	636 #if(RF_FAM == 61)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	637 /* In order to implement the NINT function for a F13.3, we check */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	638 /* if var_32 + 0.5218 is a multiple of 218 /
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	639 quotient=(WORD16)((WORD32)(((WORD32)(var_32+(1<<17)))/(1<<18)));
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	640 var_16=quotient*4;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	641 #else
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	642 /* In order to implement the NINT function for a F13.3, we check */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	643 /* if var_32 + 0.5219 is a multiple of 219 /
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	644 quotient=(WORD16)((WORD32)(((WORD32)(var_32+(1<<18)))/(1<<19)));
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	645 var_16=quotient*8;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	646 #endif
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	647 if (var_16>C_max_step)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	648 Psi_quant[C_N_del]=C_max_step;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	649 else
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	650 if(var_16<C_min_step)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	651 Psi_quant[C_N_del]=C_min_step;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	652 else Psi_quant[C_N_del]=var_16; /* F13.3 */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	653
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	654 }/end AFC_CLOSE_LOOP/
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	655 } /* end else AFC_INIT*/
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	656
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	657 *frame_count=0;
82 ef6cf21cf9d6 l1_ctl.c: passes compilation, but doesn't match old object yet Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 81 diff changeset	658 return(Psi_quant[C_N_del]>>3); /* F16.0 */
80 6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	659
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	660 #else
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	661
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	662 } /* end case algo 1 */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	663
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	664
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	665 /* algo2 + init + estimator/predictor */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	666 case ALGO_AFC_LQG_PREDICTOR:
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	667 {
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	668 /******************************************************************/
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	669 /* (New) VCXO Algorithm */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	670 /******************************************************************/
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	671
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	672 switch (phase) {
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	673 case AFC_INIT_CENTER :
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	674 case AFC_INIT_MAX :
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	675 case AFC_INIT_MIN :
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	676 quant_avg = 0;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	677 M_Count = 0;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	678 for (i = 0; i <= C_PSI_AVG_SIZE_D ; i++) //omaps00090550
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	679 psi_avg[i] = 0;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	680 first_avg = 1;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	681 good_snr = 0;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	682
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	683 // DAC search algorithm is as follows - up to 12 attempts are made
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	684 // DAC search algorithm uses three values : DAC_center -> DAC_max -> DAC_min ->
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	685 // The first four attempts are made on DAC_center
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	686 // The next four attempts are made on DAC_max
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	687 // The last four attempts are made on DAC_min
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	688 // There are statistical reasons for trying four times
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	689
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	690 switch (phase)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	691 {
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	692 case AFC_INIT_CENTER:
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	693 psi_quant = l1_config.params.afc_dac_center;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	694 break;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	695 case AFC_INIT_MAX:
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	696 psi_quant = l1_config.params.afc_dac_max;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	697 break;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	698 case AFC_INIT_MIN:
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	699 psi_quant = l1_config.params.afc_dac_min;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	700 break;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	701 default :
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	702 break;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	703 }
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	704
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	705 /* F0.32 * F13.3 = F5.35 */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	706 psi_past[C_N_del]=Mult_40b(l1_config.params.psi_st_32,psi_quant, &guardout);
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	707 /* (F13.3<<16 )+(F5.35>>16) = F13.19 */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	708 psi_past[C_N_del]=((WORD32)guardout<<16)+((UWORD32)psi_past[C_N_del]>>16);
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	709
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	710 break;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	711
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	712 case AFC_OPEN_LOOP :
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	713 {
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	714 /* VCXO changes for spurious FB detection */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	715 if (l1s.spurious_fb_detected == TRUE)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	716 {
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	717 psi_quant = old_psi_quant;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	718
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	719 for(i=0;i<C_N_del+1;i++)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	720 psi_past[i] = old_psi_past[i];
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	721
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	722 /* reset the spurious_fb_detected_flag */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	723 l1s.spurious_fb_detected = FALSE;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	724 } /* end of spuriousFB detected */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	725
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	726 /* save in memory the old AFC related values */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	727 old_psi_quant = psi_quant;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	728
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	729 for(i=0;i<C_N_del+1;i++)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	730 old_psi_past[i] = psi_past[i];
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	731
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	732 /* delay line for psi_quant values */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	733 for (i = 1; i <= C_N_del; i++)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	734 psi_past[i-1] = psi_past[i];
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	735
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	736 /* (F16.0 * F1.15 = F17.15) << 4 = F13.19 */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	737 var_32 = (WORD32) ((WORD32)angle * l1_config.params.psi_sta_inv) << 4;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	738
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	739 #if(RF_FAM == 61)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	740 /* In order to implement the NINT function for a F16.0,*/
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	741 /we check if var_32 + 0.5218 is a multiple of 218 */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	742 var_16 = (WORD16)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	743 ((WORD32) (((WORD32)(var_32 + (1<<17))) / (1<<18)));
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	744 var_16 = var_16 * 4;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	745 #else
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	746 /* In order to implement the NINT function for a F16.0,*/
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	747 /we check if var_32 + 0.5219 is a multiple of 219 */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	748 var_16 = (WORD16)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	749 ((WORD32) (((WORD32)(var_32 + (1<<18))) / (1<<19)));
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	750 var_16 = var_16 * 8;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	751 #endif
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	752 if (var_16 > C_max_step)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	753 psi_quant = Add_Sat_sign_16b(psi_quant,C_max_step);
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	754 else if (var_16 < C_min_step)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	755 psi_quant = Add_Sat_sign_16b(psi_quant,C_min_step);
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	756 else psi_quant = Add_Sat_sign_16b(psi_quant,var_16); /* F13.3 */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	757 /* F0.32 * F13.3 = F5.35 */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	758 psi_past[C_N_del]=Mult_40b(l1_config.params.psi_st_32,psi_quant, &guardout);
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	759 /* (F13.3<<16 )+(F5.35>>16) = F13.19 */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	760 psi_past[C_N_del]=((WORD32)guardout<<16)+((UWORD32)psi_past[C_N_del]>>16);
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	761
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	762 }
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	763 break;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	764
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	765 case AFC_CLOSED_LOOP :
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	766
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	767 /* delay line for psi_quant values */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	768 for (i = 1; i <= C_N_del; i++)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	769 psi_past[i-1] = psi_past[i];
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	770
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	771 /************************************/
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	772 /* Estimation */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	773 /************************************/
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	774 if ( (l1_config.params.rgap_algo != 0) &&
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	775 ((l1_mode==CON_EST_MODE2)\|\|(l1_mode==DEDIC_MODE)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	776 #if L1_GPRS
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	777 \|\| l1_mode==PACKET_TRANSFER_MODE
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	778 #endif
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	779 ))
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	780 {
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	781
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	782 M_Count += *frame_count;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	783 if (snr >= l1_config.params.afc_snr_thr) {
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	784 // Accumulate average over N TDMA frames
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	785 psi_avg[0] += psi_past[C_N_del];
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	786 // Count number of good snr's within window_avg_size chunks
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	787 good_snr++;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	788 }
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	789 // M_Count >= M ?
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	790 if (M_Count >= l1_config.params.afc_win_avg_size_M) {
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	791 // M_Count counts how far we have reached in the window_avg_size blocks
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	792
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	793 // Scale estimate relative to good snr - Don't divide by zero in case of bad measurements
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	794 if (good_snr > 0)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	795 psi_avg[0] /= good_snr;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	796
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	797 // We now have an estimation over window_avg_size TDMA frames in psi_avg[0]
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	798 if (first_avg == 1) {
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	799 first_avg = 0;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	800 // Use first estimation as best guess for the other avg values
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	801 // This is used both at initialisation and when returning from reception gap
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	802 for (i = 1; i <= C_PSI_AVG_SIZE_D ; i++)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	803 psi_avg[i] = psi_avg[0];
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	804 }
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	805
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	806 // Estimation 1st order
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	807 // Use biggest window to reduce noise effects signal in psi values
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	808 // NOTE: Due to performance issues division by MSIZE is in predictor
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	809 if (l1_config.params.rgap_algo >= 1) {
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	810 quant_avg = (WORD16) (psi_avg[0] - psi_avg[C_PSI_AVG_SIZE_D]);
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	811 }
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	812
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	813 for (i = C_PSI_AVG_SIZE_D - 1; i >= 0 ; i--)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	814 psi_avg[i+1] = psi_avg[i];
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	815 psi_avg[0] = 0;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	816 M_Count = 0;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	817 good_snr = 0;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	818 }
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	819
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	820 } else {
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	821 // No estmation when in Idle mode (DEEP or BIG SLEEP) => Reset!
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	822 first_avg = 1;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	823 M_Count = 0;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	824 good_snr = 0;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	825 psi_avg[0] = 0;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	826 }
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	827
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	828 if (snr >= l1_config.params.afc_snr_thr) {
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	829 /********************/
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	830 /* Filter algorithm */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	831 /********************/
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	832
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	833 /* No prediction during normal operation */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	834 B_Count= 0;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	835
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	836 /* Clip error angle */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	837 if (angle > C_thr_phi)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	838 angle = C_thr_phi;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	839 if (angle < -C_thr_phi)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	840 angle = -C_thr_phi;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	841
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	842 Phi_32 = psi_past[C_N_del] - psi_past[0]; /* F13.19 */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	843 /* Phi = angle - Phi_32*/
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	844 Phi_32 = ((WORD32) angle << 4) - Phi_32;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	845 /* F1.15 * 4 = F13.19 */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	846 Phi = (WORD16)((WORD32)((WORD32)(Phi_32 + (1<<3)))/ (1<<4)); /* F17.15 */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	847 /* (F0.20 * F1.15) >> 16 = F13.19 */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	848 var_32 = (L * Phi + (1<<15)) >> 16;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	849 psi_past[C_N_del] = Add_Sat_sign_32b(psi_past[C_N_del],var_32);
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	850
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	851
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	852 }
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	853 else
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	854 {
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	855 /************************************/
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	856 /* Prediction */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	857 /************************************/
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	858
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	859 // Only predict in dedicated mode
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	860 // NO prediction in idle mode
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	861 // l1a_l1s_com.dedic_set.SignalCode = NULL
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	862 if ( (l1_config.params.rgap_algo != 0) &&
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	863 ((l1_mode==CON_EST_MODE2)\|\|(l1_mode==DEDIC_MODE)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	864 #if L1_GPRS
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	865 \|\| l1_mode==PACKET_TRANSFER_MODE
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	866 #endif
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	867 ))
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	868 {
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	869 /* Prediction of psi during reception gaps */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	870 B_Count
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	871 += *frame_count;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	872
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	873 /* Predict psi ONLY when we have sufficient measurements available */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	874 /* If we don't have enough measurements we don't do anything (= 0th order estimation)*/
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	875
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	876 // Was the consecutive bad SNRs threshold value exceeded?
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	877 if (B_Count>= l1_config.params.rgap_bad_snr_count_B) {
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	878
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	879 // Predict with 0th order estimation is the default
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	880
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	881 // Predict with 1st order estimation
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	882 if (l1_config.params.rgap_algo >= 1)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	883 {
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	884 psi_past[C_N_del] = Add_Sat_sign_32b(psi_past[C_N_del],
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	885 ((quant_avg * (l1_config.params.rgap_bad_snr_count_B))/(C_MSIZE))
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	886 );
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	887 }
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	888
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	889 B_Count= B_Count - l1_config.params.rgap_bad_snr_count_B;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	890
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	891 // Indicate by raising first_avg flag that a reception gap has occurred
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	892 // I.e. the psi_avg table must be reinitialised after leaving reception gap
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	893 first_avg = 1;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	894
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	895 // Counters in estimation part must also be reset
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	896 M_Count = 0;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	897 good_snr = 0;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	898 psi_avg[0] = 0;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	899 }
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	900 }
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	901 }
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	902
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	903 /* Quantize psi value */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	904
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	905 /* F0.19 * 16.0 = F16.19 */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	906 var_32 = Sat_Mult_20sign_16unsign(psi_past[C_N_del],l1_config.params.psi_st_inv);
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	907
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	908 #if(RF_FAM == 61)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	909 /* In order to implement the NINT function for a F13.3,*/
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	910 /we check if var_32 + 0.5218 is a multiple of 218 */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	911 var_16 = (WORD16)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	912 ((WORD32)((WORD32)(var_32 + (1<<17))) / (1<<18));
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	913 var_16 = var_16 * 4;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	914 #else
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	915 /* In order to implement the NINT function for a F13.3,*/
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	916 /we check if var_32 + 0.5219 is a multiple of 219 */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	917 var_16 = (WORD16)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	918 ((WORD32)((WORD32)(var_32 + (1<<18))) / (1<<19));
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	919 var_16 = var_16 * 8;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	920 #endif
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	921 if (var_16 > C_max_step)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	922 psi_quant = C_max_step;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	923 else if (var_16 < C_min_step)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	924 psi_quant = C_min_step;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	925 else
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	926 psi_quant = var_16; /* F13.3 */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	927 break;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	928 } // switch phase
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	929
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	930 *frame_count = 0;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	931
82 ef6cf21cf9d6 l1_ctl.c: passes compilation, but doesn't match old object yet Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 81 diff changeset	932 return (psi_quant >> 3); /* F16.0 */
80 6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	933 } /* end case algo 2 */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	934
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	935 /* algo1 + init + estimator/predictor */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	936 case ALGO_AFC_KALMAN_PREDICTOR:
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	937 {
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	938 if ((phase==AFC_INIT_CENTER) \|\| (phase==AFC_INIT_MAX) \|\| (phase==AFC_INIT_MIN))
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	939 {
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	940 // WARNING
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	941 // In this case, "angle" variable contains EEPROM_AFC initialization value
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	942 // directly loaded from EEPROM, and "snr" variable is not meaningful.
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	943 /* Static variables initialisation */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	944
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	945 quant_avg = 0;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	946 M_Count = 0;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	947 for (i = 0; i <=C_PSI_AVG_SIZE_D ; i++) //omaps00090550
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	948 psi_avg[i] = 0;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	949 first_avg = 1;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	950 good_snr = 0;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	951
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	952 // DAC search algorithm is as follows - up to 12 attempts are made
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	953 // DAC search algorithm uses three values : DAC_center -> DAC_max -> DAC_min ->
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	954 // The first four attempts are made on DAC_center
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	955 // The next four attempts are made on DAC_max
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	956 // The last four attempts are made on DAC_min
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	957 // There are statistical reasons for trying four times
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	958
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	959 switch (phase) {
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	960 case AFC_INIT_CENTER:
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	961 Psi_quant[C_N_del] = l1_config.params.afc_dac_center;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	962 break;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	963 case AFC_INIT_MAX:
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	964 Psi_quant[C_N_del] = l1_config.params.afc_dac_max;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	965 break;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	966 case AFC_INIT_MIN:
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	967 Psi_quant[C_N_del] = l1_config.params.afc_dac_min;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	968 break;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	969 default :
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	970 break;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	971 }
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	972
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	973 P=C_cov_start;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	974 Psi=0;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	975 if (angle>C_max_step)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	976 Psi_quant[C_N_del]=C_max_step;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	977 else
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	978 if(angle<C_min_step)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	979 Psi_quant[C_N_del]=C_min_step;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	980 else Psi_quant[C_N_del]=angle;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	981
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	982 /* F0.32 * F13.3 = F5.35 */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	983 Psi=Mult_40b(l1_config.params.psi_st_32,Psi_quant[C_N_del], &guardout);
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	984 /* (F13.3<<16 )+(F5.35>>16) = F13.19 */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	985 Psi=((WORD32)guardout<<16)+((UWORD32)Psi>>16);
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	986
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	987 } /* end AFC_INIT*/
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	988 else
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	989 {
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	990 if (phase==AFC_OPEN_LOOP)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	991 {
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	992 /* relaod last good values in the ALGO */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	993 if (l1s.spurious_fb_detected == TRUE)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	994 {
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	995 for(i=0;i<C_N_del+1;i++)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	996 Psi_quant[i] = old_Psi_quant[i];
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	997
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	998 Psi = old_Psi;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	999 l1s.spurious_fb_detected = FALSE;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1000 }
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1001
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1002 /* Save the old values in memory */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1003 for(i=0;i<C_N_del+1;i++)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1004 old_Psi_quant[i] = Psi_quant[i];
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1005 old_Psi = Psi;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1006
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1007 /* delay line for Psi_quant values */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1008 for (i=1;i<=C_N_del;i++)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1009 Psi_quant[i-1]=Psi_quant[i];
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1010
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1011 var_32=(WORD32)((WORD32)angle*l1_config.params.psi_sta_inv)<<4;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1012 /(F16.0 F1.15 = F17.15) << 4 = F13.19 */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1013
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1014 #if(RF_FAM == 61)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1015 /* In order to implement the NINT function for a F16.0, we check */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1016 /* if var_32 + 0.5218 is a multiple of 218 /
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1017 quotient=(WORD16)((WORD32)(((WORD32)(var_32+(1<<17)))/(1<<18)));
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1018 var_16=quotient*4;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1019 #else
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1020 /* In order to implement the NINT function for a F16.0, we check */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1021 /* if var_32 + 0.5219 is a multiple of 219 /
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1022 quotient=(WORD16)((WORD32)(((WORD32)(var_32+(1<<18)))/(1<<19)));
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1023 var_16=quotient*8;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1024 #endif
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1025 if (var_16>C_max_step)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1026 Psi_quant[C_N_del]=Add_Sat_sign_16b(Psi_quant[C_N_del],C_max_step);
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1027 else
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1028 if(var_16<C_min_step)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1029 Psi_quant[C_N_del]=Add_Sat_sign_16b(Psi_quant[C_N_del],C_min_step);
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1030 else Psi_quant[C_N_del]=Add_Sat_sign_16b(Psi_quant[C_N_del],var_16); /* F13.3 */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1031
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1032
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1033
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1034 /* F0.32 * F13.3 = F5.35 */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1035 Psi=Mult_40b(l1_config.params.psi_st_32,Psi_quant[C_N_del], &guardout);
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1036 /* (F13.3<<16 )+(F5.35>>16) = F13.19 */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1037 Psi=((WORD32)guardout<<16)+((UWORD32)Psi>>16);
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1038
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1039 }/end if AFC_OPEN_LOOP/
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1040 else
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1041 {
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1042
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1043 /* delay line for Psi_quant values */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1044 for (i=1;i<=C_N_del;i++)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1045 Psi_quant[i-1]=Psi_quant[i];
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1046
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1047 /************************************/
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1048 /* Estimation */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1049 /************************************/
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1050 if ( (l1_config.params.rgap_algo != 0) &&
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1051 ((l1_mode==CON_EST_MODE2)\|\|(l1_mode==DEDIC_MODE)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1052 #if L1_GPRS
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1053 \|\| l1_mode==PACKET_TRANSFER_MODE
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1054 #endif
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1055 ))
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1056 {
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1057
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1058 M_Count += *frame_count;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1059 if (snr >= l1_config.params.afc_snr_thr) {
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1060 // Accumulate average over N TDMA frames
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1061 psi_avg[0] += psi_past[C_N_del];
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1062 // Count number of good snr's within window_avg_size chunks
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1063 good_snr++;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1064 }
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1065
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1066 // M_Count >= M ?
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1067 if (M_Count >= l1_config.params.afc_win_avg_size_M) {
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1068 // M_Count counts how far we have reached in the window_avg_size blocks
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1069
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1070 // Scale estimate relative to good snr - Don't divide by zero in case of bad measurements
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1071 if (good_snr > 0)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1072 psi_avg[0] /= good_snr;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1073
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1074 // We now have an estimation over window_avg_size TDMA frames in psi_avg[0]
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1075 if (first_avg == 1) {
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1076 first_avg = 0;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1077 // Use first estimation as best guess for the other avg values
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1078 // This is used both at initialisation and when returning from reception gap
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1079 for (i = 1; i <= C_PSI_AVG_SIZE_D ; i++)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1080 psi_avg[i] = psi_avg[0];
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1081 }
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1082
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1083 // Estimation 1st order
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1084 // Use biggest window to reduce noise effects signal in psi values
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1085 // NOTE: Due to performance issues division by MSIZE is in predictor
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1086 if (l1_config.params.rgap_algo >= 1) {
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1087 quant_avg = (WORD16) (psi_avg[0] - psi_avg[C_PSI_AVG_SIZE_D]);
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1088 }
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1089
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1090 for (i = C_PSI_AVG_SIZE_D - 1; i >= 0 ; i--)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1091 psi_avg[i+1] = psi_avg[i];
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1092 psi_avg[0] = 0;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1093 M_Count = 0;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1094 good_snr = 0;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1095 }
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1096
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1097 } else {
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1098 // No estmation when in Idle mode (DEEP or BIG SLEEP) => Reset!
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1099 first_avg = 1;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1100 M_Count = 0;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1101 good_snr = 0;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1102 psi_avg[0] = 0;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1103 }
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1104
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1105 /********************/
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1106 /* Filter algorithm */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1107 /********************/
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1108
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1109 /* Covariance error is increased of C_Q */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1110 P=P+(frame_count)C_Q;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1111
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1112 /* Clipping of P */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1113 if (P>C_thr_P) P=C_thr_P;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1114
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1115 if (snr>=C_thr_snr)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1116 {
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1117 /* Clipping of error angle */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1118 if (angle>C_thr_phi)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1119 angle=C_thr_phi;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1120 if (angle<-C_thr_phi)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1121 angle=-C_thr_phi;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1122
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1123 /* Kalman gain */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1124 /K=P(1/(P+C_a0_kalman+(C_g_kalmanRNS))) /
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1125 /C_a0_kalman=0.01 /
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1126 /C_g_kalman =0.05 /
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1127 num=(C_g_kalman/snr)+P+C_a0_kalman;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1128 /* (F2.30 / F6.10) = F 12.20 */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1129
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1130 /* denom = P << 19 = F 1.39 */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1131 /* extension of denom=P to a 40 bits variable */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1132 /* denom (F12.20) << 16 = F 4.36 */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1133 guard1=(WORD16)((WORD32)P>>16);
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1134 /* denom = P<<16 = (F4.36) << 3 = F 1.39 */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1135 denomH=(UWORD16)P;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1136 /* Low part of denom is equal to 0, because P has been 16 */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1137 /* bits left shifted previously. */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1138 denomH_3msb=(denomH>>13)&0x0007;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1139 guard1=(guard1<<3)\|denomH_3msb;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1140 denomH<<=3;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1141 denom=denomH<<16; //(UWORD32) removed typecast omaps00090550
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1142 /* num + guard1 are a 40 bits representation of P */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1143 /* In order to compute P(F1.39)/num, we sample P in guard1 */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1144 /* (scaled to a 32 bits number) and num (32 bits number) */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1145 /* K = ((guard1<<24)/num)<<8 + (denom/num) */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1146 var1=(WORD32)guard1<<24;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1147 var1=var1/num;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1148 var1=(WORD32)var1<<8;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1149 /* var2 is an unsigned variable, var1 contains signed guard*/
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1150 /* bits. */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1151 var2= ((WORD32)(denom)/(num)); //omaps00090550
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1152 K = (var1+var2)<<1; /* F1.39 / F12.20 = F13.19 */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1153 /* F13.19 << 1 = F12.20 */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1154
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1155 /* Clipping of the Kalman gain */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1156 if (K>=C_thr_K)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1157 K=C_thr_K;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1158
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1159 /*******************************************************/
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1160 /* P=(1-K)P = 0.8 0.5 at maximum */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1161 /*******************************************************/
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1162 /* Perform a positive variable F12.20 multiplication by*/
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1163 /* positive variable F12.20 */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1164 var_16=(WORD16)(1048576L-K); /* acclow(1-K) = F12.20 */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1165 guard1=0; /* positive variable */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1166 var1=UMult_40b(P,var_16,&guard1);
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1167 var_16=(WORD16)((1048576L-K)>>16);
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1168 /* acchigh(1-K) = F12.20 */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1169 var2=Pvar_16; / var2 = 0x80000 * 0xc */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1170 /* at maximum, so result */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1171 /* is 32 bits WORD32 and */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1172 /* equal 0x600000 */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1173 /* extension of var2 to a 40 bits variable : var2<<16 */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1174 guard2=(WORD16)((WORD32)var2>>16);
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1175 guard1guard2=((WORD32)guard1<<16) \|((WORD32) guard2&0x0000FFFFL);
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1176 var2=var2<<16;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1177 var_32=Add_40b(guard1guard2,var1,var2,&guardout);
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1178 /* var_32 (F8.40) >> 16 = F8.24 */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1179 LGuard=(WORD32)guardout<<16;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1180 var1=(UWORD32)var_32>>16;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1181 /* var_32 >> 4 = F12.20 */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1182 P=(var1+LGuard)>>4;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1183
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1184 Phi_32=Mult_40b(l1_config.params.psi_st_32,Psi_quant[0],&guardout);
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1185 /* F0.32 * F13.3 = F5.35 */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1186 LGuard=(WORD32)guardout<<16; /* var_32 (F5.35) >> 16 */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1187 /* F13.19 */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1188 var1=(UWORD32)Phi_32>>16;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1189 Phi_32=Psi-(LGuard+var1); /* F13.19 */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1190
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1191 /Phi=angle-Phi_32/
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1192 Phi_32=((WORD32)angle<<4)-Phi_32;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1193 /* F1.15 * 4 = F13.19 */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1194 Phi=(WORD16)(Phi_32>>4); /* F17.15 */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1195 /var1=KPhi F12.20 * F1.15 = 13.35 */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1196 guard1=0;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1197 var1=Mult_40b(K,Phi,&guard1);
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1198 /* var1 (F13.35) >> 16 */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1199 /* F13.19 */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1200 LGuard=(WORD32)guard1<<16;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1201 var1=(UWORD32)var1>>16;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1202 Psi+=var1+LGuard;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1203 } else {
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1204 /************************************/
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1205 /* Prediction */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1206 /************************************/
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1207
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1208 // Only predict in dedicated mode
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1209 // NO prediction in idle mode
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1210 // l1a_l1s_com.dedic_set.SignalCode = NULL
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1211 if ( (l1_config.params.rgap_algo != 0) &&
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1212 ((l1_mode==CON_EST_MODE2)\|\|(l1_mode==DEDIC_MODE)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1213 #if L1_GPRS
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1214 \|\| l1_mode==PACKET_TRANSFER_MODE
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1215 #endif
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1216 ))
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1217 {
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1218
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1219 /* Prediction of psi during reception gaps */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1220 B_Count+= *frame_count;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1221
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1222 /* Predict psi ONLY when we have sufficient measurements available */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1223 /* If we don't have enough measurements we don't do anything (= 0th order estimation)*/
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1224
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1225 // Was the consecutive bad SNRs threshold value exceeded?
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1226 if (B_Count>= l1_config.params.rgap_bad_snr_count_B) {
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1227
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1228 // Predict with 0th order estimation is the default
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1229
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1230 // Predict with 1st order estimation
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1231 if (l1_config.params.rgap_algo >= 1)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1232 Psi += ((quant_avg * (l1_config.params.rgap_bad_snr_count_B))/(C_MSIZE));
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1233
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1234 B_Count= B_Count - l1_config.params.rgap_bad_snr_count_B;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1235
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1236 // Indicate by raising first_avg flag that a reception gap has occurred
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1237 // I.e. the psi_avg table must be reinitialised after leaving reception gap
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1238 first_avg = 1;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1239
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1240 // Counters in estimation part must also be reset
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1241 M_Count = 0;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1242 good_snr = 0;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1243 psi_avg[0] = 0;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1244 }
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1245 }
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1246 }
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1247
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1248 /* Quantize psi value */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1249
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1250 var_32=Mult_40b(Psi,l1_config.params.psi_st_inv,&guardout);
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1251 /* F13.19 * C = F13.19 */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1252
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1253 #if(RF_FAM == 61)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1254 /* In order to implement the NINT function for a F13.3, we check */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1255 /* if var_32 + 0.5218 is a multiple of 218 /
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1256 quotient=(WORD16)((WORD32)(((WORD32)(var_32+(1<<17)))/(1<<18)));
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1257 var_16=quotient*4;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1258 #else
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1259 /* In order to implement the NINT function for a F13.3, we check */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1260 /* if var_32 + 0.5219 is a multiple of 219 /
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1261 quotient=(WORD16)((WORD32)(((WORD32)(var_32+(1<<18)))/(1<<19)));
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1262 var_16=quotient*8;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1263 #endif
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1264 if (var_16>C_max_step)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1265 Psi_quant[C_N_del]=C_max_step;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1266 else
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1267 if(var_16<C_min_step)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1268 Psi_quant[C_N_del]=C_min_step;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1269 else Psi_quant[C_N_del]=var_16; /* F13.3 */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1270
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1271
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1272 }/end AFC_CLOSE_LOOP/
82 ef6cf21cf9d6 l1_ctl.c: passes compilation, but doesn't match old object yet Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 81 diff changeset	1273 } /* end else AFC_INIT*/
ef6cf21cf9d6 l1_ctl.c: passes compilation, but doesn't match old object yet Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 81 diff changeset	1274
ef6cf21cf9d6 l1_ctl.c: passes compilation, but doesn't match old object yet Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 81 diff changeset	1275 *frame_count = 0;
ef6cf21cf9d6 l1_ctl.c: passes compilation, but doesn't match old object yet Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 81 diff changeset	1276 return(Psi_quant[C_N_del]>>3); /* F16.0 */
80 6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1277 } /* end case algo 3 */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1278 #endif
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1279
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1280 #if (VCXO_ALGO == 1)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1281 default:
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1282 return 0;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1283 //omaps00090550 break;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1284 } // end of Switch
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1285 #endif
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1286
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1287 } /* end l1ctl_afc */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1288
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1289
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1290 /************************************/
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1291 /* Automatic timing control (TOA) */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1292 /************************************/
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1293
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1294 #if (TOA_ALGO == 2)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1295
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1296 #define TOA_DEBUG_ENABLE 0
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1297
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1298
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1299 #if (TOA_DEBUG_ENABLE == 1)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1300
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1301 #define TOA_MAKE_ZERO 0
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1302
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1303 #define TOA_LOG_BUFFER_LENGTH 4096
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1304
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1305 typedef struct
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1306 {
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1307 UWORD16 SNR_val;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1308 UWORD16 TOA_val;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1309 UWORD16 l1_mode;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1310 UWORD16 toa_frames_counter;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1311 UWORD16 fn_mod42432;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1312 }T_TOA_log_debug;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1313
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1314
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1315 T_TOA_log_debug toa_log_debug[TOA_LOG_BUFFER_LENGTH];
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1316 UWORD32 toa_log_index;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1317
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1318 UWORD32 toa_make_zero_f;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1319
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1320 #endif
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1321
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1322 /-------------------------------------------------------/
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1323 /* l1ctl_toa() */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1324 /-------------------------------------------------------/
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1325 /* Parameters : */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1326 /* Return : */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1327 /* Functionality : */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1328 /-------------------------------------------------------/
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1329
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1330 WORD16 l1ctl_toa (UWORD8 phase, UWORD32 l1_mode, UWORD16 SNR_val, UWORD16 TOA_val)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1331 {
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1332 WORD16 TOA_period_len = TOA_PERIOD_LEN [l1_mode];
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1333 WORD16 TOA_SHIFT=ISH_INVALID;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1334 UWORD16 cumul_abs;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1335 WORD16 cumul_sign;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1336 WORD32 prod_tmp, div_tmp,prod_sign;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1337 WORD32 toa_update_flag=0;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1338 WORD16 cumul;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1339 UWORD16 cumul_counter;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1340 #if (NEW_TOA_ALGO == 1)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1341 UWORD16 Trans_active;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1342 static WORD16 cumul_noTrans =0;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1343 static UWORD16 period_counter_noTrans =0;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1344
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1345 if ((l1_mode==CON_EST_MODE2)\|\|(l1_mode==DEDIC_MODE)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1346 #if L1_GPRS
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1347 \|\| l1_mode==PACKET_TRANSFER_MODE
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1348 #endif
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1349 )
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1350 Trans_active=TRUE;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1351 else Trans_active=FALSE;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1352 #endif
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1353 if (phase==TOA_INIT)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1354 {
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1355 #if (NEW_TOA_ALGO == 1)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1356 cumul_noTrans =0;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1357 period_counter_noTrans =0;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1358 #endif
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1359
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1360 l1s.toa_var.toa_frames_counter=0;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1361 l1s.toa_var.toa_accumul_counter=0;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1362 l1s.toa_var.toa_accumul_value=0;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1363 #if (TOA_DEBUG_ENABLE == 1)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1364 toa_log_index = 0;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1365 #if (TOA_MAKE_ZERO == 1)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1366 toa_make_zero_f = 1;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1367 #else
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1368 toa_make_zero_f = 0;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1369 #endif
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1370 #endif
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1371
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1372 return (TOA_SHIFT);
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1373 }
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1374
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1375 cumul = l1s.toa_var.toa_accumul_value;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1376 cumul_counter = l1s.toa_var.toa_accumul_counter;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1377
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1378 #if (TOA_DEBUG_ENABLE == 1)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1379 toa_log_debug[toa_log_index].SNR_val = SNR_val;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1380 toa_log_debug[toa_log_index].TOA_val = TOA_val;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1381 toa_log_debug[toa_log_index].l1_mode = l1_mode;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1382 toa_log_debug[toa_log_index].toa_frames_counter = l1s.toa_var.toa_frames_counter;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1383 toa_log_debug[toa_log_index].fn_mod42432 = l1s.actual_time.fn_mod42432;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1384
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1385 toa_log_index++;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1386 if(toa_log_index == TOA_LOG_BUFFER_LENGTH)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1387 {
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1388 toa_log_index = 0;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1389 }
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1390 #endif /* #if (TOA_DEBUG_ENABLE == 1) */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1391
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1392 #if (TRACE_TYPE == 5)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1393 trace_toa_sim_ctrl(SNR_val, TOA_val, l1_mode, l1s.toa_var.toa_frames_counter,
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1394 l1s.toa_var.toa_accumul_counter, l1s.toa_var.toa_accumul_value);
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1395 #endif
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1396
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1397 l1s.toa_var.toa_frames_counter++;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1398
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1399 {
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1400 /* Fix for TOA */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1401 #define DSP_CALC_NO_TABS_HO 0x3CA4
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1402
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1403 UWORD16 *toa_ho_fix;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1404 toa_ho_fix=(UWORD16 *)API_address_dsp2mcu(DSP_CALC_NO_TABS_HO);
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1405
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1406 if ((TOA_val >= 22) \|\| (TOA_val <= 6)) {
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1407 *toa_ho_fix = 1;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1408 }
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1409
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1410 if (*toa_ho_fix == 1) {
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1411 if((TOA_val <= 18) && (TOA_val >= 10)) {
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1412 *toa_ho_fix = 0;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1413 }
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1414 } else {
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1415 *toa_ho_fix = 0;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1416 }
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1417 }
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1418
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1419
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1420 #if (NEW_TOA_ALGO == 1)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1421 if (Trans_active)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1422 {
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1423 #endif
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1424 if (SNR_val>= L1_TOA_SNR_THRESHOLD)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1425 {
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1426 cumul_counter++;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1427
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1428 prod_tmp = L1_TOA_LAMBDA * cumul;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1429 prod_tmp = prod_tmp + ((0x00004000)); // basically for rounding
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1430 div_tmp = ((prod_tmp >> 15) & (0x0000FFFF));
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1431 cumul = div_tmp;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1432
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1433 // implemented below is
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1434 // cumul = cumul + (L1_TOA_ONE_MINUS_LAMBDA * signum(TOA_Val - L1_TOA_EXPECTED_TOA))
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1435 if(TOA_val > L1_TOA_EXPECTED_TOA) {
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1436 cumul = cumul + L1_TOA_ONE_MINUS_LAMBDA;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1437 }
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1438 else if (TOA_val < L1_TOA_EXPECTED_TOA) {
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1439 cumul = cumul - L1_TOA_ONE_MINUS_LAMBDA;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1440 }
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1441 } // End if SNR_val
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1442
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1443 if(l1s.toa_var.toa_update_flag == TRUE)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1444 {
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1445 toa_update_flag = 1;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1446 }
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1447
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1448 if (toa_update_flag)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1449 {
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1450 cumul_sign = (cumul>0)? 1: -1;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1451 cumul_abs = cumul_sign*cumul;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1452 if(cumul_counter <= 5)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1453 {
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1454 TOA_SHIFT = (cumul_abs<=L1_TOA_THRESHOLD_15)? 0: cumul_sign;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1455 }
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1456 else if(cumul_counter == 6)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1457 {
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1458 TOA_SHIFT = (cumul_abs<=L1_TOA_THRESHOLD_20)? 0: cumul_sign;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1459 }
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1460 else if(cumul_counter == 7)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1461 {
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1462 TOA_SHIFT = (cumul_abs<=L1_TOA_THRESHOLD_25)? 0: cumul_sign;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1463 }
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1464 else if(cumul_counter >= 8)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1465 {
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1466 TOA_SHIFT = (cumul_abs<=L1_TOA_THRESHOLD_30)? 0: cumul_sign;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1467 }
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1468 #if (TRACE_TYPE==1) \|\| (TRACE_TYPE==4)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1469 trace_info.toa_trace_var.toa_accumul_value = cumul;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1470 trace_info.toa_trace_var.toa_accumul_counter = cumul_counter;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1471 trace_info.toa_trace_var.toa_frames_counter = l1s.toa_var.toa_frames_counter;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1472 #endif
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1473
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1474 cumul = 0;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1475 cumul_counter = 0;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1476 l1s.toa_var.toa_frames_counter = 0;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1477 l1s.toa_var.toa_update_flag = FALSE;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1478
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1479 #if (TOA_DEBUG_ENABLE == 1)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1480 #if (TOA_MAKE_ZERO == 1)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1481 if (toa_make_zero_f == 1)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1482 {
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1483 TOA_SHIFT=0;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1484 }
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1485 #endif /#if (TOA_DEBUG_ENABLE == 1)/
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1486 #endif /#if (TOA_MAKE_ZERO == 1)/
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1487
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1488 } // end of if toa_update_flag
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1489 #if (NEW_TOA_ALGO == 1)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1490
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1491 }
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1492
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1493 else
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1494 {
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1495 period_counter_noTrans++;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1496
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1497 if (SNR_val>= L1_TOA_SNR_THRESHOLD)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1498 {
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1499 cumul_noTrans = cumul_noTrans + TOA_val - L1_TOA_EXPECTED_TOA;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1500
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1501 } // End if SNR_val
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1502
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1503 if (l1s.toa_var.toa_update_flag == TRUE)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1504 {
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1505 switch (period_counter_noTrans)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1506 {
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1507 case 2:
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1508 if (cumul_noTrans>=0)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1509 TOA_SHIFT = (cumul_noTrans+1) >>1 ;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1510 else
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1511 TOA_SHIFT = (cumul_noTrans) >>1 ;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1512 break;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1513 case 3: /* Not fully accurate rounding*/
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1514 if (cumul_noTrans>=0)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1515 TOA_SHIFT = (cumul_noTrans+2)/3 ;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1516 else
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1517 TOA_SHIFT = (cumul_noTrans-2)/3 ;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1518 break;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1519 case 4:
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1520 if (cumul_noTrans>=0)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1521 TOA_SHIFT = (cumul_noTrans+2) >>2 ;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1522 else
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1523 TOA_SHIFT = (cumul_noTrans+1) >>2 ;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1524 break;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1525 default:
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1526 TOA_SHIFT = cumul_noTrans;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1527 break;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1528 } /* end switch*/
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1529
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1530 if (TOA_SHIFT>8)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1531 TOA_SHIFT =8;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1532 if (TOA_SHIFT<-8)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1533 TOA_SHIFT =-8;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1534
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1535 #if (TRACE_TYPE==1) \|\| (TRACE_TYPE==4)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1536 trace_info.toa_trace_var.toa_accumul_value = cumul_noTrans;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1537 trace_info.toa_trace_var.toa_accumul_counter = period_counter_noTrans;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1538 trace_info.toa_trace_var.toa_frames_counter = period_counter_noTrans;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1539 #endif
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1540
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1541 cumul_noTrans = 0;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1542 period_counter_noTrans = 0;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1543 l1s.toa_var.toa_update_flag = FALSE;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1544 #if (TOA_DEBUG_ENABLE == 1)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1545 #if (TOA_MAKE_ZERO == 1)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1546 if (toa_make_zero_f == 1)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1547 {
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1548 TOA_SHIFT=0;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1549 }
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1550 #endif /#if (TOA_DEBUG_ENABLE == 1)/
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1551 #endif /#if (TOA_MAKE_ZERO == 1)/
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1552
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1553 } // end if update_flag
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1554 }
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1555 #endif
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1556 // error a TOA is waiting to be updated in the TPU and will be erased
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1557 #if (TRACE_TYPE==1) \|\| (TRACE_TYPE==4)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1558 if (l1s.toa_var.toa_shift != ISH_INVALID)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1559 {
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1560 l1_trace_toa_not_updated (); // should not occur!!
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1561 }
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1562 #endif
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1563
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1564 if (TOA_SHIFT != ISH_INVALID) // new TOA => set the mask frames
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1565 {
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1566 // Set mask counter to 2 (2 frames masked).
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1567 l1s.toa_var.toa_snr_mask = 2;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1568 }
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1569
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1570 l1s.toa_var.toa_accumul_value = cumul;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1571 l1s.toa_var.toa_accumul_counter = cumul_counter;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1572
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1573 return(TOA_SHIFT);
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1574
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1575 } // l1ctl_toa
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1576
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1577
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1578 #else
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1579 /-------------------------------------------------------/
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1580 /* l1ctl_toa_update() */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1581 /-------------------------------------------------------/
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1582 /* Parameters : */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1583 /* Return : */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1584 /* Functionality : */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1585 /-------------------------------------------------------/
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1586 WORD16 l1ctl_toa_update(UWORD32 *TOASP, UWORD32 l1_mode)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1587 {
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1588 static UWORD16 Old_TOA_estimated=12; //unit is Qbit
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1589 UWORD32 TOAMAX;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1590 WORD16 IZW,ISH,i;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1591 UWORD32 TOA_estimated=0; //unit is Qbit
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1592 UWORD16 Trans_active;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1593
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1594 if ((l1_mode==CON_EST_MODE2)\|\|(l1_mode==DEDIC_MODE)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1595 #if L1_GPRS
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1596 \|\| l1_mode==PACKET_TRANSFER_MODE
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1597 #endif
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1598 )
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1599 Trans_active=TRUE;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1600 else Trans_active=FALSE;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1601
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1602 /* TOA offset computation and clock adjustement */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1603 TOAMAX=0;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1604 for (i=1;i<TOA_HISTO_LEN;i++)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1605 {
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1606 if (TOASP[i]>TOAMAX)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1607 TOAMAX=TOASP[i];
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1608 }
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1609 TOAMAX >>= C_RED;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1610 i=1;IZW=0;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1611 while (i<TOA_HISTO_LEN && IZW==0)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1612 {
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1613 if (TOASP[i]>=TOAMAX)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1614 IZW=i;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1615 i++;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1616 }
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1617
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1618 /* Estimated TOA calculation */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1619 if (TOASP[IZW-1]<(2*TOAMAX/3))
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1620 {
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1621 TOA_estimated=IZW;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1622 TOA_estimated *= 4; // unit in QBit
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1623 }
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1624 else
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1625 {
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1626 UWORD32 TOA_divisor = 0;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1627 TOA_estimated=(TOASP[IZW]IZW)+(TOASP[IZW-1](IZW-1)>>C_GEW);
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1628 TOA_estimated *= 8; //F13.3 in order to have qBit precision
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1629 TOA_divisor = TOASP[IZW]+(TOASP[IZW-1] >> C_GEW);
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1630 if (TOA_divisor!=0)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1631 {
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1632 TOA_estimated/= TOASP[IZW]+(TOASP[IZW-1] >> C_GEW);
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1633 TOA_estimated /= 2; // unit in QBit ("/8" then "*4" = "/2")
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1634 }
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1635 else
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1636 {
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1637 TOA_estimated = 0;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1638 }
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1639 }
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1640
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1641 if (Trans_active)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1642 TOA_estimated=(TOA_estimated+(Old_TOA_estimated+4)) / 2;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1643
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1644 /* Offset calculation*/
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1645 if (TOA_estimated>=17 \|\| TOA_estimated<=15)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1646 ISH=TOA_estimated - 16;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1647 else
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1648 ISH=0;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1649
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1650 if (Trans_active)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1651 {
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1652 if (ISH>1) ISH=1;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1653 if (ISH<-1) ISH=-1;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1654 }
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1655 else
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1656 {
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1657 if (ISH>8) ISH=8;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1658 if (ISH<-8) ISH=-8;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1659 }
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1660
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1661 Old_TOA_estimated = TOA_estimated - ISH - 4;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1662
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1663
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1664 return (ISH);
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1665 }
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1666
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1667 /-------------------------------------------------------/
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1668 /* l1ctl_toa() */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1669 /-------------------------------------------------------/
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1670 /* Parameters : */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1671 /* Return : */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1672 /* Functionality : generate an histogram of TOA weighted */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1673 /* with SNR */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1674 /-------------------------------------------------------/
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1675 WORD16 l1ctl_toa(UWORD8 phase, UWORD32 l1_mode, UWORD16 SNR_val, UWORD16 TOA_val, BOOL toa_update, UWORD16 toa_period_count
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1676 #if (FF_L1_FAST_DECODING == 1)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1677 , UWORD8 skipped_values
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1678 #endif
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1679 )
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1680 {
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1681 // xSignalHeaderRec *msg;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1682 UWORD16 i;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1683 WORD16 TOA_period_len = TOA_PERIOD_LEN[l1_mode];
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1684 static UWORD32 histo[TOA_HISTO_LEN];
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1685 static WORD16 period_counter=0;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1686 UWORD32 SNR_ZW;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1687 WORD16 ISH=ISH_INVALID;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1688
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1689 UWORD8 histo_center;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1690
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1691 #if 0
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1692 if ((l1_mode==CON_EST_MODE2)\|\|(l1_mode==DEDIC_MODE))
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1693 histo_center=4;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1694 else
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1695 histo_center=5;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1696 #else
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1697 histo_center=4;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1698 #endif
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1699
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1700
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1701 if (phase==TOA_INIT)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1702 {
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1703 period_counter=0;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1704
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1705 for (i=0;i<TOA_HISTO_LEN;i++)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1706 histo[i]=0;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1707 histo[histo_center]=128; //F6.10
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1708
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1709 return(ISH);
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1710 }
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1711 #if (FF_L1_FAST_DECODING == 1)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1712 /* Manage any missing bursts due to fast decoding */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1713 period_counter += skipped_values;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1714 #endif
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1715
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1716 period_counter++;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1717 /* Filter update */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1718 if (SNR_val>=C_SNRGR)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1719 {
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1720 if (SNR_val>C_SNR_THR)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1721 SNR_ZW=C_SNR_THR;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1722 else
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1723 SNR_ZW=SNR_val;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1724 histo[TOA_val+1]+=SNR_ZW; /* if TOA=0 histo[1]++ */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1725 /* if TOA=1 histo[2]++ */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1726 /* ... */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1727 /* if TOA=9 histo[10]++ */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1728 /* histo[0] is reserved for computation */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1729 }
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1730
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1731 #if L1_GPRS
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1732 if (l1_mode==PACKET_TRANSFER_MODE)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1733 {
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1734 if (*toa_update)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1735 {
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1736 // Get ISH.
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1737 ISH = l1ctl_toa_update(histo, l1_mode);
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1738
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1739 //reset TOA period length counter
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1740 period_counter=0;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1741
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1742 //reset histogram
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1743 for (i=0;i<TOA_HISTO_LEN;i++)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1744 histo[i]=0;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1745 histo[histo_center]=128; //F6.10
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1746
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1747 *toa_update = FALSE; // reset TOA update flag
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1748 *toa_period_count = 0; // reset TOA period counter
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1749 }
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1750 }
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1751 else
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1752 #endif
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1753 if (period_counter>=TOA_period_len)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1754 // It is time to compute a new ISH and to reset the histogram.
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1755 // Rem: ">=" is very important since a "l1 mode" change can give
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1756 // a "TOA_period_len" smaller than the previous one an
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1757 // therefore a "period_counter" may be already higher than
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1758 // the new "TOA_period_len".
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1759 {
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1760 // Get ISH.
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1761 ISH = l1ctl_toa_update(histo, l1_mode);
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1762
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1763 //reset TOA period length counter
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1764 period_counter=0;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1765
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1766 //reset histogram
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1767 for (i=0;i<TOA_HISTO_LEN;i++)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1768 histo[i]=0;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1769 histo[histo_center]=128; //F6.10
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1770 }
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1771
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1772 // error a TOA is waiting to be updated in the TPU and will be erased
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1773 #if (TRACE_TYPE==1) \|\| (TRACE_TYPE==4)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1774 if (l1s.toa_shift != ISH_INVALID)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1775 {
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1776 l1_trace_toa_not_updated(); // should not occur !!
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1777 }
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1778 #endif
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1779
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1780 if (ISH != ISH_INVALID) // new TOA => set the mask frames
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1781 {
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1782 // Set mask counter to 2 (2 frames masked).
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1783 l1s.toa_snr_mask = 2;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1784 }
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1785
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1786 return(ISH);
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1787 }
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1788 #endif
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1789
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1790 /-------------------------------------------------------/
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1791 /* l1ctl_txpwr() */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1792 /-------------------------------------------------------/
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1793 /* Parameters : */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1794 /* Return : */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1795 /* Functionality : */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1796 /-------------------------------------------------------/
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1797 UWORD8 l1ctl_txpwr(UWORD8 target_txpwr, UWORD8 current_txpwr)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1798 {
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1799 if(target_txpwr > current_txpwr)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1800 {
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1801 current_txpwr ++; // Increase TX power by 2 dB.
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1802 }
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1803 else
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1804 if(target_txpwr < current_txpwr)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1805 {
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1806 current_txpwr --; // Decrease TX power by 2 dB.
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1807 }
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1808
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1809 return(current_txpwr);
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1810 }
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1811
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1812
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1813 /************************************/
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1814 /* Automatic Gain Control */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1815 /************************************/
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1816 /-------------------------------------------------------/
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1817 /* l1ctl_encode_delta1() */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1818 /-------------------------------------------------------/
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1819 /* Parameters : */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1820 /* Return : */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1821 /* Functionality : */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1822 /-------------------------------------------------------/
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1823 #if(L1_FF_MULTIBAND == 0)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1824 WORD8 l1ctl_encode_delta1(UWORD16 radio_freq)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1825 {
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1826 switch(l1_config.std.id)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1827 {
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1828 case GSM:
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1829 case GSM_E:
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1830 case DCS1800:
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1831 case PCS1900:
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1832 case GSM850:
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1833 return(l1_config.std.cal_freq1_band1);
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1834 case DUAL:
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1835 case DUALEXT:
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1836 case DUAL_US:
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1837 if(radio_freq >= l1_config.std.first_radio_freq_band2)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1838 return(l1_config.std.cal_freq1_band2);
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1839 else
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1840 return(l1_config.std.cal_freq1_band1);
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1841 }
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1842 return 0;//omaps00090550
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1843
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1844 }
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1845 #endif
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1846 /-------------------------------------------------------/
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1847 /* l1ctl_encode_lna() */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1848 /-------------------------------------------------------/
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1849 /* Parameters : */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1850 /* Return : */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1851 /* Functionality : */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1852 /-------------------------------------------------------/
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1853 #if (L1_FF_MULTIBAND == 0)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1854 void l1ctl_encode_lna( UWORD8 input_level,
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1855 UWORD8 *lna_state,
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1856 UWORD16 radio_freq)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1857 {
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1858
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1859 /*** LNA Hysteresis is implemented as following :
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1860
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1861 \|
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1862 On\|---<>----+-------+
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1863 \| \| \|
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1864 LNA \| \| \|
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1865 \| ^ v
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1866 \| \| \|
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1867 \| \| \|
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1868 Off\| +-------+----<>-----
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1869 +--------------------------------
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1870 50 40 30 20 input_level /-dBm
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1871 THR_HIGH THR_LOW ***/
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1872
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1873
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1874
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1875
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1876
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1877 if(((l1_config.std.id == DUAL) \|\| (l1_config.std.id == DUALEXT) \|\|(l1_config.std.id == DUAL_US)) &&
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1878 (radio_freq >= l1_config.std.first_radio_freq_band2))
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1879 {
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1880 if ( input_level > l1_config.std.lna_switch_thr_high_band2 ) // < -40dBm ?
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1881 {
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1882 *lna_state = LNA_ON; // lna_off = FALSE
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1883 }
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1884 else if ( input_level < l1_config.std.lna_switch_thr_low_band2 ) // > -30dBm ?
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1885 {
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1886 *lna_state = LNA_OFF; // lna off = TRUE
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1887 }
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1888 }
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1889 else
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1890 {
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1891 if ( input_level > l1_config.std.lna_switch_thr_high_band1 ) // < -40dBm ?
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1892 {
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1893 *lna_state = LNA_ON; // lna_off = FALSE
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1894 }
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1895 else if ( input_level < l1_config.std.lna_switch_thr_low_band1 ) // > -30dBm ?
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1896 {
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1897 *lna_state = LNA_OFF; // lna off = TRUE
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1898 }
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1899 }
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1900
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1901 }
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1902
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1903 #endif
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1904
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1905 /-------------------------------------------------------/
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1906 /* l1ctl_csgc() */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1907 /-------------------------------------------------------/
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1908 /* Description: */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1909 /* ============ */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1910 /* If we are running the first pass of a measurement */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1911 /* session, we use the HIGH_AGC default agc setting to */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1912 /* compute the input level from the measured power from */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1913 /* the DSP. If this input level is saturated we set a */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1914 /* saturation flag, otherwise we validate the measure and*/
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1915 /* store, for the considered carrier, the input level. */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1916 /* When all the carriers have been scanned and some have */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1917 /* been flagged "saturated", we measure them with the */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1918 /* LOW_AGC agc setting, then store, for the considered */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1919 /* carrier, the input level. */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1920 /-------------------------------------------------------/
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1921 UWORD8 l1ctl_csgc(UWORD8 pm, UWORD16 radio_freq)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1922 {
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1923 WORD16 current_IL, current_calibrated_IL =0; //omaps00090550
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1924 WORD8 delta1_freq, delta2_freq;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1925 WORD16 delta_drp_gain=0;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1926 UWORD32 index;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1927 UWORD16 g_magic;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1928 UWORD16 arfcn;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1929 UWORD16 dco_algo_ctl_pw_temp = 0;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1930 UWORD8 if_ctl = 0;
81 6124f48fc1fa l1_ctl.c: fixes from the freecalypso-sw/gsm-fw version Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 80 diff changeset	1931 #if (RF_RAM == 61) && (CODE_VERSION != SIMULATION)
80 6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1932 UWORD8 if_threshold = C_IF_ZERO_LOW_THRESHOLD_GSM;
81 6124f48fc1fa l1_ctl.c: fixes from the freecalypso-sw/gsm-fw version Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 80 diff changeset	1933 #endif
80 6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1934
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1935 #if (L1_FF_MULTIBAND == 0)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1936
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1937 // initialize index
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1938 index = radio_freq - l1_config.std.radio_freq_index_offset;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1939
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1940 #else
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1941
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1942 index =
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1943 l1_multiband_radio_freq_convert_into_operative_radio_freq(radio_freq);
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1944
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1945 #endif /if(L1_FF_MULTIBAND == 0)/
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1946
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1947 delta1_freq = l1ctl_encode_delta1(radio_freq);
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1948 delta2_freq = l1ctl_encode_delta2(radio_freq);
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1949
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1950 g_magic = l1ctl_get_g_magic(radio_freq);
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1951 #if (L1_FF_MULTIBAND == 0)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1952 arfcn = Convert_l1_radio_freq(radio_freq);
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1953 #endif
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1954
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1955 if (l1a_l1s_com.full_list.meas_1st_pass_read)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1956 {
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1957 // We validate or not power measure (pm) for the considered carrier
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1958 // with measurement achieved with HIGH_AGC setting. We are working
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1959 // with non calibrated IL to avoid saturation
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1960 #if(RF_FAM == 61)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1961 #if (CODE_VERSION != SIMULATION)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1962
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1963 #if (PWMEAS_IF_MODE_FORCE == 0)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1964 cust_get_if_dco_ctl_algo(&dco_algo_ctl_pw_temp, &if_ctl, (UWORD8) L1_IL_INVALID ,
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1965 0,
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1966 radio_freq,if_threshold);
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1967 #else
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1968 if_ctl = IF_120KHZ_DSP;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1969 dco_algo_ctl_pw_temp = DCO_IF_0KHZ;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1970 #endif
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1971
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1972 #if (L1_FF_MULTIBAND == 0)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1973 delta_drp_gain = drp_gain_correction(arfcn, LNA_ON, (l1_config.params.high_agc << 1)); // F7.1 format
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1974 #else
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1975 delta_drp_gain = drp_gain_correction(radio_freq, LNA_ON, (l1_config.params.high_agc << 1)); // F7.1 format
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1976 #endif // MULTIBAND == 0 else
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1977
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1978 if(if_ctl == IF_100KHZ_DSP){
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1979 delta_drp_gain += SCF_ATTENUATION_LIF_100KHZ;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1980 }
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1981 else{ /* i.e. if_ctl = IF_120KHZ_DSP*/
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1982 delta_drp_gain += SCF_ATTENUATION_LIF_120KHZ;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1983 }
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1984
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1985 #endif
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1986 #endif
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1987 if (0==pm) // Check and filter illegal pm value by using last valid IL
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1988 current_IL = (WORD16)(l1a_l1s_com.last_input_level[index].input_level);
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1989 else
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1990 {
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1991 #if TESTMODE
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1992 if (!l1_config.agc_enable)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1993 current_IL = (WORD16)(-(pm - ( (l1_config.tmode.rx_params.agc << 1) - delta_drp_gain ) - g_magic));
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1994 else
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1995 #endif
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1996 current_IL = (WORD16)(-(pm - ( (l1_config.params.high_agc <<1) - delta_drp_gain) - g_magic));
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1997 // for array index purpose, we work with positive IL
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1998
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	1999 }
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2000
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2001 // NOTE: lna_value do not appear in this formula because lna is ALWAYS ON for
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2002 // ---- this algorithm, so lna_value=lna_off*l1_config.params.lna_att_gsm=0
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2003
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2004 if ((current_IL<l1_config.params.high_agc_sat_thr) // Warning : we are working with positive IL
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2005 // for IL_2_AGC_xx index purpose.
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2006 #if TESTMODE
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2007 && (l1_config.agc_enable)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2008 #endif
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2009 )
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2010 {
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2011 // pm is saturated so measure is not valid
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2012 l1a_l1s_com.full_list.nbr_sat_carrier_ctrl++;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2013 l1a_l1s_com.full_list.nbr_sat_carrier_read++;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2014 l1a_l1s_com.full_list.sat_flag[l1a_l1s_com.full_list.next_to_read] = 1;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2015 }
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2016 else
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2017 {
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2018 current_calibrated_IL = current_IL - delta1_freq - delta2_freq;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2019
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2020 #if TESTMODE
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2021 // When running with fixed AGC setting saturated carriers may occur:
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2022 // protect against negative IL;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2023 if ((!l1_config.agc_enable) && (current_calibrated_IL < 0))
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2024 {
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2025 current_calibrated_IL=0;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2026 current_IL=0;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2027 }
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2028 #endif
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2029
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2030 // Protect IL stores against overflow
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2031 if (current_calibrated_IL>INDEX_MAX)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2032 current_calibrated_IL=INDEX_MAX;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2033 if (current_IL>INDEX_MAX)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2034 current_IL=INDEX_MAX;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2035
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2036 // we validate the measure and save input_level and lna_off fields.
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2037 l1ctl_encode_lna((UWORD8)(current_calibrated_IL>>1),
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2038 &(l1a_l1s_com.last_input_level[index].lna_off),
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2039 radio_freq);
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2040
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2041 l1a_l1s_com.last_input_level[index].input_level = (UWORD8)current_IL;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2042 l1a_l1s_com.full_list.sat_flag[l1a_l1s_com.full_list.next_to_read] = 0;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2043 }
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2044 }
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2045 else // 2nd pass if any.
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2046 {
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2047 // we validate the measure and save input_level and lna_off(always 0)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2048 // fields.
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2049 #if(RF_FAM == 61)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2050 #if (CODE_VERSION != SIMULATION)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2051 cust_get_if_dco_ctl_algo(&dco_algo_ctl_pw_temp, &if_ctl, (UWORD8) L1_IL_INVALID,
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2052 0,radio_freq,if_threshold);
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2053 #if (L1_FF_MULTIBAND == 0)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2054 delta_drp_gain = drp_gain_correction(arfcn, LNA_ON, (l1_config.params.low_agc << 1)); // F7.1 format
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2055 #else
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2056 delta_drp_gain = drp_gain_correction(radio_freq, LNA_ON, (l1_config.params.low_agc << 1)); // F7.1 format
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2057 #endif
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2058 if(if_ctl == IF_100KHZ_DSP){
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2059 delta_drp_gain += SCF_ATTENUATION_LIF_100KHZ;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2060 }
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2061 else{ /* i.e. if_ctl = IF_120KHZ_DSP*/
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2062 delta_drp_gain += SCF_ATTENUATION_LIF_120KHZ;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2063 }
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2064 #endif
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2065 #endif
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2066
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2067
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2068 if (0==pm) // Check and filter illegal pm value by using last valid IL
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2069 current_IL = (WORD16)(l1a_l1s_com.last_input_level[index].input_level);
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2070 else
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2071 current_IL = (WORD16)(-(pm - ( (l1_config.params.low_agc << 1) - delta_drp_gain ) - g_magic));
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2072
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2073 current_calibrated_IL = current_IL - delta1_freq - delta2_freq;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2074
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2075 // Protect IL stores against overflow
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2076 if (current_calibrated_IL>INDEX_MAX)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2077 current_calibrated_IL=INDEX_MAX;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2078 if (current_IL>INDEX_MAX)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2079 current_IL=INDEX_MAX;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2080
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2081 l1ctl_encode_lna((UWORD8)(current_calibrated_IL>>1),
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2082 &(l1a_l1s_com.last_input_level[index].lna_off),
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2083 radio_freq);
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2084
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2085 l1a_l1s_com.last_input_level[index].input_level = (UWORD8)current_IL;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2086
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2087 l1a_l1s_com.full_list.sat_flag[l1a_l1s_com.full_list.next_to_read] = 0;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2088 }
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2089
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2090 return((UWORD8)current_calibrated_IL);
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2091 }
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2092
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2093 /-------------------------------------------------------/
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2094 /* l1ctl_pgc() */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2095 /-------------------------------------------------------/
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2096 /* Description : For a given radio_freq, last_known_agc is */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2097 /* ============ based on a prior knowledge (the last */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2098 /* stored input_level for the considered */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2099 /* carrier). From the power measurement on */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2100 /* this carrier (pm), we update the */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2101 /* input_level for this carrier, for the */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2102 /* next task to control. */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2103 /-------------------------------------------------------/
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2104 UWORD8 l1ctl_pgc(UWORD8 pm, UWORD8 last_known_il,
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2105 UWORD8 lna_off, UWORD16 radio_freq)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2106 {
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2107 WORD32 last_known_agc;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2108 WORD32 current_IL, current_calibrated_IL;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2109 WORD8 delta1_freq, delta2_freq;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2110 WORD16 delta_drp_gain=0;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2111 WORD32 index, lna_value;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2112 UWORD16 arfcn;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2113 UWORD16 dco_algo_ctl_pw_temp = 0;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2114 UWORD8 if_ctl = 0;
81 6124f48fc1fa l1_ctl.c: fixes from the freecalypso-sw/gsm-fw version Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 80 diff changeset	2115 #if (RF_RAM == 61) && (CODE_VERSION != SIMULATION)
80 6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2116 UWORD8 if_threshold = C_IF_ZERO_LOW_THRESHOLD_GSM;
81 6124f48fc1fa l1_ctl.c: fixes from the freecalypso-sw/gsm-fw version Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 80 diff changeset	2117 #endif
80 6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2118
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2119 #if (L1_FF_MULTIBAND == 0)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2120
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2121 // initialize index
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2122 index = radio_freq - l1_config.std.radio_freq_index_offset;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2123
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2124 #else
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2125
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2126 index = l1_multiband_radio_freq_convert_into_operative_radio_freq(radio_freq);
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2127
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2128 #endif // #if (L1_FF_MULTIBAND == 0) else
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2129
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2130 delta1_freq = l1ctl_encode_delta1(radio_freq);
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2131 delta2_freq = l1ctl_encode_delta2(radio_freq);
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2132
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2133 lna_value = lna_off * l1ctl_get_lna_att(radio_freq);
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2134
82 ef6cf21cf9d6 l1_ctl.c: passes compilation, but doesn't match old object yet Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 81 diff changeset	2135 last_known_agc = (Cust_get_agc_from_IL(radio_freq, last_known_il >> 1, PWR_ID)) << 1;
80 6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2136 // F7.1 in order to be compatible with
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2137 // pm and IL formats [-20,+140 in F7.1]
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2138 // contain the input_level value we use
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2139 // in the associated CTL task to build
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2140 // the agc used in this CTL.
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2141 #if (L1_FF_MULTIBAND == 0)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2142 arfcn = Convert_l1_radio_freq(radio_freq);
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2143 #else
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2144 arfcn=radio_freq;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2145 #endif
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2146
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2147 #if(RF_FAM == 61)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2148 #if (CODE_VERSION != SIMULATION)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2149
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2150 #if (PWMEAS_IF_MODE_FORCE == 0)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2151 cust_get_if_dco_ctl_algo(&dco_algo_ctl_pw_temp, &if_ctl, (UWORD8) L1_IL_VALID ,
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2152 last_known_il,
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2153 radio_freq,if_threshold);
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2154 #else
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2155 if_ctl = IF_120KHZ_DSP;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2156 dco_algo_ctl_pw_temp = DCO_IF_0KHZ;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2157 #endif
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2158
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2159 delta_drp_gain = drp_gain_correction(arfcn, lna_off, last_known_agc); // F7.1 format
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2160 if(if_ctl == IF_100KHZ_DSP){
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2161 delta_drp_gain += SCF_ATTENUATION_LIF_100KHZ;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2162 }
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2163 else{ /* i.e. if_ctl = IF_120KHZ_DSP*/
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2164 delta_drp_gain += SCF_ATTENUATION_LIF_120KHZ;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2165 }
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2166
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2167 #endif
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2168 #endif
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2169
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2170 if (0==pm) // Check and filter illegal pm value by using last valid IL
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2171 current_IL = l1a_l1s_com.last_input_level[index].input_level ;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2172 else
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2173 current_IL = -(pm - (last_known_agc - delta_drp_gain) + lna_value - l1ctl_get_g_magic(radio_freq));
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2174
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2175 current_calibrated_IL = current_IL - delta1_freq - delta2_freq;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2176
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2177 // Protect IL stores against overflow
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2178 if (current_calibrated_IL>INDEX_MAX)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2179 current_calibrated_IL=INDEX_MAX;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2180 if (current_IL>INDEX_MAX)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2181 current_IL=INDEX_MAX;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2182
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2183 // we validate the measure and save input_level and lna_off fields
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2184 l1ctl_encode_lna((UWORD8)(current_calibrated_IL>>1),
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2185 &(l1a_l1s_com.last_input_level[index].lna_off),
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2186 radio_freq);
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2187
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2188 l1a_l1s_com.last_input_level[index].input_level = (UWORD8)current_IL;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2189
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2190 return((UWORD8)current_calibrated_IL);
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2191 }
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2192
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2193
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2194 /-------------------------------------------------------/
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2195 /* l1ctl_pgc2() */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2196 /-------------------------------------------------------/
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2197 /* Description : */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2198 /* ============= */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2199 /* from power measurement pm_high_agc, */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2200 /* achieve with an HIGH_AGC setting, and pm_low_agc */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2201 /* achieve with a LOW_AGC seeting, we deduce the new */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2202 /* AGC to apply in the next CTL task. */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2203 /-------------------------------------------------------/
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2204 void l1ctl_pgc2(UWORD8 pm_high_agc, UWORD8 pm_low_agc, UWORD16 radio_freq)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2205 {
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2206 UWORD8 pm;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2207 WORD32 IL_high_agc, IL_low_agc, new_IL, current_calibrated_IL;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2208 WORD8 delta1_freq, delta2_freq;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2209 WORD16 delta_high_drp_gain=0;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2210 WORD16 delta_low_drp_gain=0;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2211 WORD32 index;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2212 UWORD16 g_magic;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2213 UWORD16 arfcn;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2214 UWORD16 dco_algo_ctl_pw_temp = 0;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2215 UWORD8 if_ctl = 0;
81 6124f48fc1fa l1_ctl.c: fixes from the freecalypso-sw/gsm-fw version Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 80 diff changeset	2216 #if (RF_RAM == 61) && (CODE_VERSION != SIMULATION)
80 6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2217 UWORD8 if_threshold = C_IF_ZERO_LOW_THRESHOLD_GSM;
81 6124f48fc1fa l1_ctl.c: fixes from the freecalypso-sw/gsm-fw version Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 80 diff changeset	2218 #endif
80 6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2219
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2220 #if (L1_FF_MULTIBAND == 0)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2221
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2222 // initialize index
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2223 index = radio_freq - l1_config.std.radio_freq_index_offset;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2224
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2225 #else
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2226
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2227 index =
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2228 l1_multiband_radio_freq_convert_into_operative_radio_freq(radio_freq);
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2229
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2230 #endif // #if (L1_FF_MULTIBAND == 0) else
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2231
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2232 delta1_freq = l1ctl_encode_delta1(radio_freq);
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2233 delta2_freq = l1ctl_encode_delta2(radio_freq);
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2234
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2235 g_magic = l1ctl_get_g_magic(radio_freq);
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2236
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2237 // lna_off was set to 0 during CTRL, so lna_value = 0 do not appear in the following
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2238 // formula.
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2239
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2240 #if (L1_FF_MULTIBAND == 0)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2241 arfcn = Convert_l1_radio_freq(radio_freq);
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2242 #else
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2243 arfcn=radio_freq;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2244 #endif
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2245
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2246 if ((0==pm_high_agc) \|\| (0==pm_low_agc)) // Check and filter illegal pm value(s) by using last valid IL
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2247 new_IL = l1a_l1s_com.last_input_level[index].input_level;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2248 else
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2249 {
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2250
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2251 #if(RF_FAM == 61)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2252 #if (CODE_VERSION != SIMULATION)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2253
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2254 #if (PWMEAS_IF_MODE_FORCE == 0)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2255 cust_get_if_dco_ctl_algo(&dco_algo_ctl_pw_temp, &if_ctl, (UWORD8) L1_IL_INVALID ,
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2256 0,
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2257 radio_freq,if_threshold);
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2258 #else
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2259 if_ctl = IF_120KHZ_DSP;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2260 dco_algo_ctl_pw_temp = DCO_IF_0KHZ;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2261 #endif
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2262
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2263
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2264 delta_high_drp_gain = drp_gain_correction(arfcn, LNA_ON, (l1_config.params.high_agc << 1)); // F7.1 format
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2265 delta_low_drp_gain = drp_gain_correction(arfcn, LNA_ON, (l1_config.params.low_agc << 1)); // F7.1 format
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2266 if(if_ctl == IF_100KHZ_DSP){
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2267 delta_high_drp_gain += SCF_ATTENUATION_LIF_100KHZ;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2268 delta_low_drp_gain += SCF_ATTENUATION_LIF_100KHZ;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2269 }
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2270 else{ /* i.e. if_ctl = IF_120KHZ_DSP*/
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2271 delta_high_drp_gain += SCF_ATTENUATION_LIF_120KHZ;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2272 delta_low_drp_gain += SCF_ATTENUATION_LIF_120KHZ;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2273 }
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2274 #endif
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2275 #endif
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2276
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2277 IL_high_agc = -(pm_high_agc - ((l1_config.params.high_agc << 1) - delta_high_drp_gain) - g_magic);
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2278 IL_low_agc = -(pm_low_agc - ((l1_config.params.low_agc << 1) - delta_low_drp_gain) - g_magic);
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2279
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2280 // HIGH_AGC and LOW_AGC are formatted to F7.1 in order to be compatible with
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2281 // pm and IL formats
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2282
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2283 if (IL_low_agc>=l1_config.params.low_agc_noise_thr)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2284 // pm_low_agc was on the noise floor, so not valid
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2285 {
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2286 // whatever the value of pm_high_agc, we consider it
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2287 // as the right setting
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2288 new_IL = IL_high_agc;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2289 pm = pm_high_agc;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2290 }
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2291 else
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2292 {
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2293 // pm_low_agc is valid.
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2294 if (IL_high_agc<=l1_config.params.high_agc_sat_thr)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2295 {
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2296 // pm_high_agc is not valid, it's saturated.
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2297 new_IL = IL_low_agc;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2298 pm = pm_low_agc;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2299 }
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2300 else
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2301 {
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2302 // both pm_low_agc and pm_high_agc are valid, so we test the one that
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2303 // gives the maximum input level and consider it as the right setting.
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2304 if (IL_high_agc<=IL_low_agc)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2305 {
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2306 new_IL = IL_high_agc;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2307 pm = pm_high_agc;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2308 }
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2309 else
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2310 {
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2311 new_IL = IL_low_agc;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2312 pm = pm_low_agc;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2313 }
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2314 }
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2315 }
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2316 }
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2317
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2318 #if (TRACE_TYPE == 1) \|\| (TRACE_TYPE == 4)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2319 RTTL1_FILL_MON_MEAS(pm_high_agc, IL_high_agc - delta1_freq - delta2_freq, MS_AGC_ID, radio_freq)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2320 RTTL1_FILL_MON_MEAS(pm_low_agc, IL_low_agc - delta1_freq - delta2_freq, MS_AGC_ID, radio_freq)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2321 #endif
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2322
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2323 current_calibrated_IL = new_IL - delta1_freq - delta2_freq;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2324
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2325 // Protect IL stores against overflow
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2326 if (current_calibrated_IL>INDEX_MAX)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2327 current_calibrated_IL=INDEX_MAX;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2328 if (new_IL>INDEX_MAX)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2329 new_IL=INDEX_MAX;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2330
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2331 // Updating of input_level and lna_off fields in order to correctly
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2332 // setting the AGC for the next task.
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2333 l1ctl_encode_lna((UWORD8)(current_calibrated_IL>>1),
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2334 &(l1a_l1s_com.last_input_level[index].lna_off),
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2335 radio_freq);
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2336
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2337 l1a_l1s_com.last_input_level[index].input_level = (UWORD8)new_IL;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2338 }
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2339
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2340
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2341 /-------------------------------------------------------/
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2342 /* l1ctl_find_max() */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2343 /-------------------------------------------------------/
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2344 /* Parameters : */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2345 /* Return : */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2346 /* Functionality : */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2347 /-------------------------------------------------------/
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2348 UWORD8 l1ctl_find_max(UWORD8 *buff, UWORD8 buffer_len)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2349 {
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2350
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2351 // WARNING: for array index purpose we work with POSITIVE input level
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2352 // so maximum search for negative numbers is equivalent to
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2353 // minimum search for positive numbers!!!!!!
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2354 // (-30 > -120 but 30 < 120)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2355
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2356 UWORD8 maximum = 240;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2357 UWORD8 i;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2358
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2359 for (i=0; i<buffer_len; i++)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2360 {
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2361 if (buff[i]<maximum)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2362 maximum=buff[i];
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2363 }
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2364
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2365 return(maximum);
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2366 }
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2367
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2368 /-------------------------------------------------------/
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2369 /* l1ctl_pagc() */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2370 /-------------------------------------------------------/
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2371 /* Description : */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2372 /* =========== */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2373 /* We deduce the last_known_agc from the last stored */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2374 /* input_level for the considered carrier. We use this */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2375 /* agc value to "build" the input level linked to the pm */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2376 /* we have just read. */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2377 /* This input level is used to feed a fifo of 4 elements */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2378 /* and then compute an input_level maximum. This value is*/
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2379 /* used to update the input_level for this carrier. This */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2380 /* input_level will be used for the next task to control.*/
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2381 /-------------------------------------------------------/
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2382 UWORD8 l1ctl_pagc(UWORD8 pm, UWORD16 radio_freq, T_INPUT_LEVEL *IL_info_ptr)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2383 {
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2384 WORD8 delta1_freq, delta2_freq;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2385 WORD16 delta_drp_gain=0;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2386 WORD32 last_known_agc;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2387 UWORD8 IL_max;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2388 WORD32 current_IL, current_calibrated_IL;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2389 UWORD8 i;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2390 WORD32 lna_value;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2391 UWORD16 arfcn;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2392 UWORD8 lna_off;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2393 UWORD16 dco_algo_ctl_pw_temp = 0;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2394 UWORD8 if_ctl = 0;
81 6124f48fc1fa l1_ctl.c: fixes from the freecalypso-sw/gsm-fw version Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 80 diff changeset	2395 #if (RF_RAM == 61) && (CODE_VERSION != SIMULATION)
80 6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2396 UWORD8 if_threshold = C_IF_ZERO_LOW_THRESHOLD_GSM;
81 6124f48fc1fa l1_ctl.c: fixes from the freecalypso-sw/gsm-fw version Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 80 diff changeset	2397 #endif
80 6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2398
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2399 delta1_freq = l1ctl_encode_delta1(radio_freq);
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2400 delta2_freq = l1ctl_encode_delta2(radio_freq);
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2401
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2402 // Update fifo
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2403 for (i=3;i>0;i--)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2404 l1a_l1s_com.Scell_info.buff_beacon[i]=l1a_l1s_com.Scell_info.buff_beacon[i-1];
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2405
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2406 // from the lna state (ON/OFF) we compute the attenuation
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2407 // that was applied to signal when performing the power
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2408 // measure.
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2409 lna_value = l1a_l1s_com.Scell_used_IL_dd.lna_off * l1ctl_get_lna_att(radio_freq);
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2410
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2411 // Compute applied agc for this pm
82 ef6cf21cf9d6 l1_ctl.c: passes compilation, but doesn't match old object yet Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 81 diff changeset	2412 last_known_agc = (Cust_get_agc_from_IL(radio_freq, l1a_l1s_com.Scell_used_IL_dd.input_level >> 1, MAX_ID)) << 1;
80 6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2413 // F7.1 in order to be compatible
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2414 // with pm and IL formats
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2415 // contain the input_level value we use
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2416 // in the associated CTL task to build
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2417 // the agc used in this CTL.
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2418
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2419 #if (L1_FF_MULTIBAND == 0)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2420 arfcn = Convert_l1_radio_freq(radio_freq);
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2421 #else
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2422 arfcn=radio_freq;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2423 #endif
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2424
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2425 #if(RF_FAM == 61)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2426 #if (CODE_VERSION != SIMULATION)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2427
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2428 cust_get_if_dco_ctl_algo(&dco_algo_ctl_pw_temp, &if_ctl, (UWORD8) L1_IL_VALID ,
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2429 l1a_l1s_com.Scell_used_IL_dd.input_level,
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2430 radio_freq,if_threshold);
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2431 lna_off = l1a_l1s_com.Scell_used_IL_dd.lna_off;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2432 delta_drp_gain = drp_gain_correction(arfcn, lna_off, last_known_agc); // F7.1 format
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2433 if(if_ctl == IF_100KHZ_DSP){
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2434 delta_drp_gain += SCF_ATTENUATION_LIF_100KHZ;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2435 }
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2436 else{ /* i.e. if_ctl = IF_120KHZ_DSP*/
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2437 delta_drp_gain += SCF_ATTENUATION_LIF_120KHZ;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2438 }
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2439
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2440 #endif
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2441 #endif
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2442
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2443 if (0==pm) // Check and filter illegal pm value by using last valid IL
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2444 current_IL = IL_info_ptr->input_level;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2445 else
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2446 current_IL = -(pm - (last_known_agc - delta_drp_gain) + lna_value - l1ctl_get_g_magic(radio_freq));
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2447
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2448 current_calibrated_IL = current_IL - delta1_freq - delta2_freq;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2449
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2450 // Protect IL stores against overflow
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2451 if (current_calibrated_IL>INDEX_MAX)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2452 current_calibrated_IL=INDEX_MAX;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2453 if (current_IL>INDEX_MAX)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2454 current_IL=INDEX_MAX;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2455
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2456 l1a_l1s_com.Scell_info.buff_beacon[0] = (UWORD8)current_IL;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2457
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2458 IL_max = l1ctl_find_max(&(l1a_l1s_com.Scell_info.buff_beacon[0]),4);
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2459
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2460 //input levels are always stored with lna_on
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2461 l1ctl_encode_lna( (UWORD8)(current_calibrated_IL>>1),
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2462 &(IL_info_ptr->lna_off),
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2463 radio_freq );
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2464
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2465 IL_info_ptr->input_level = IL_max;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2466
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2467 #if L2_L3_SIMUL
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2468 #if (DEBUG_TRACE==BUFFER_TRACE_PAGC)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2469 buffer_trace(4,IL_info_ptr->input_level,last_known_agc,
82 ef6cf21cf9d6 l1_ctl.c: passes compilation, but doesn't match old object yet Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 81 diff changeset	2470 l1a_l1s_com.Scell_used_IL_dd.input_level,Cust_get_agc_from_IL(radio_freq, IL_max >> 1, MAX_ID));
80 6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2471 #endif
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2472 #endif
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2473
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2474 return((UWORD8)current_calibrated_IL);
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2475 }
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2476
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2477 /-------------------------------------------------------/
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2478 /* l1ctl_dpagc() */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2479 /-------------------------------------------------------/
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2480 /* Description : */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2481 /* =========== */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2482 /* Based on the same principle as the one used for PAGC */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2483 /* algorithm except that we feed 3 different fifo: */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2484 /* 1) one is dedicated to BCCH carrier */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2485 /* 2) another one is dedicated to all the other type of */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2486 /* bursts */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2487 /* 3) the last one is dedicated to non DTX influenced */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2488 /* bursts */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2489 /-------------------------------------------------------/
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2490 UWORD8 l1ctl_dpagc(BOOL dtx_on, BOOL beacon, UWORD8 pm, UWORD16 radio_freq, T_INPUT_LEVEL *IL_info_ptr)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2491 {
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2492 UWORD8 av_G_all, av_G_DTX;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2493 UWORD8 max_G_all, max_G_DTX;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2494 WORD32 last_known_agc, new_IL, current_calibrated_IL;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2495 WORD8 delta1_freq, delta2_freq;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2496 WORD16 delta_drp_gain=0;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2497 UWORD8 i;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2498 UWORD8 *tab_ptr;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2499 T_DEDIC_SET *aset;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2500 WORD32 lna_value;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2501 UWORD16 arfcn;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2502 UWORD8 lna_off;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2503 UWORD16 dco_algo_ctl_pw_temp = 0;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2504 UWORD8 if_ctl = 0;
81 6124f48fc1fa l1_ctl.c: fixes from the freecalypso-sw/gsm-fw version Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 80 diff changeset	2505 #if (RF_RAM == 61) && (CODE_VERSION != SIMULATION)
80 6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2506 UWORD8 if_threshold = C_IF_ZERO_LOW_THRESHOLD_GSM;
81 6124f48fc1fa l1_ctl.c: fixes from the freecalypso-sw/gsm-fw version Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 80 diff changeset	2507 #endif
80 6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2508
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2509 delta1_freq = l1ctl_encode_delta1(radio_freq);
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2510 delta2_freq = l1ctl_encode_delta2(radio_freq);
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2511
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2512 aset = l1a_l1s_com.dedic_set.aset;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2513
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2514 if (beacon)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2515 tab_ptr = l1a_l1s_com.Scell_info.buff_beacon;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2516 else
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2517 tab_ptr = aset->G_all;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2518
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2519 // Update fifo
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2520 for (i=DPAGC_FIFO_LEN-1;i>0;i--)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2521 tab_ptr[i]=tab_ptr[i-1];
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2522
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2523 #if TESTMODE
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2524 if (!l1_config.agc_enable)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2525 {
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2526 // AGC gain can only be controlled in 2dB steps as the bottom bit (bit zero)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2527 // corresponds to the lna_off bit
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2528 last_known_agc = (l1_config.tmode.rx_params.agc) << 1;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2529 lna_value = (l1_config.tmode.rx_params.lna_off) * l1ctl_get_lna_att(radio_freq);
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2530 }
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2531 else
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2532 #endif
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2533 {
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2534 #if DPAGC_MAX_FLAG
82 ef6cf21cf9d6 l1_ctl.c: passes compilation, but doesn't match old object yet Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 81 diff changeset	2535 last_known_agc = (Cust_get_agc_from_IL(radio_freq, l1a_l1s_com.Scell_used_IL_dd.input_level >> 1, MAX_ID)) << 1;
80 6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2536 // F7.1 in order to be compatible with pm and IL formats
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2537 #else
82 ef6cf21cf9d6 l1_ctl.c: passes compilation, but doesn't match old object yet Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 81 diff changeset	2538 last_known_agc = (Cust_get_agc_from_IL(radio_freq, l1a_l1s_com.Scell_used_IL_dd.input_level >> 1, AV_ID)) << 1;
80 6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2539 // F7.1 in order to be compatible with pm and IL formats
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2540 #endif
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2541 // input_level_dd : contain the input_level value we use
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2542 // in the associated CTL task to build the agc used in this CTL.
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2543
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2544 lna_value = l1a_l1s_com.Scell_used_IL_dd.lna_off * l1ctl_get_lna_att(radio_freq);
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2545 }
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2546
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2547 #if (L1_FF_MULTIBAND == 0)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2548 arfcn = Convert_l1_radio_freq(radio_freq);
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2549 #else
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2550 arfcn=radio_freq;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2551 #endif
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2552
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2553 #if(RF_FAM == 61)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2554 #if (CODE_VERSION != SIMULATION)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2555
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2556 cust_get_if_dco_ctl_algo(&dco_algo_ctl_pw_temp, &if_ctl, (UWORD8) L1_IL_VALID ,
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2557 l1a_l1s_com.Scell_used_IL_dd.input_level,
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2558 radio_freq,if_threshold);
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2559 lna_off = l1a_l1s_com.Scell_used_IL_dd.lna_off;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2560 delta_drp_gain = drp_gain_correction(arfcn, lna_off, last_known_agc); // F7.1 format
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2561 if(if_ctl == IF_100KHZ_DSP){
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2562 delta_drp_gain += SCF_ATTENUATION_LIF_100KHZ;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2563 }
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2564 else{ /* i.e. if_ctl = IF_120KHZ_DSP*/
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2565 delta_drp_gain += SCF_ATTENUATION_LIF_120KHZ;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2566 }
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2567
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2568 #endif
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2569 #endif
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2570
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2571 if (0==pm) // Check and filter illegal pm value by using last valid IL
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2572 new_IL = IL_info_ptr->input_level;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2573 else
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2574 new_IL = -(pm - (last_known_agc - delta_drp_gain) + lna_value - l1ctl_get_g_magic(radio_freq));
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2575
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2576 current_calibrated_IL = new_IL - delta1_freq - delta2_freq;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2577
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2578 // Protect IL stores against overflow
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2579 if (current_calibrated_IL>INDEX_MAX)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2580 current_calibrated_IL=INDEX_MAX;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2581
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2582 #if TESTMODE
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2583 if (l1tm.tmode_state.dedicated_active) // Implies l1_config.TestMode = 1
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2584 {
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2585 // Update l1tm.tmode_stats.rssi_fifo (delay line from index 3 to 0)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2586 for (i=(sizeof(l1tm.tmode_stats.rssi_fifo)/sizeof(l1tm.tmode_stats.rssi_fifo[0]))-1; i>0; i--)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2587 {
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2588 l1tm.tmode_stats.rssi_fifo[i] = l1tm.tmode_stats.rssi_fifo[i-1];
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2589 }
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2590 l1tm.tmode_stats.rssi_fifo[0] = current_calibrated_IL; // rssi value is F7.1
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2591 l1tm.tmode_stats.rssi_recent = current_calibrated_IL; // rssi value is F7.1
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2592 }
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2593 #endif
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2594
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2595 if (new_IL>INDEX_MAX)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2596 new_IL=INDEX_MAX;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2597
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2598 tab_ptr[0] = (UWORD8)new_IL;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2599
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2600 if (dtx_on && !beacon)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2601 {
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2602 // Update DTX fifo
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2603 for (i=DPAGC_FIFO_LEN-1;i>0;i--)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2604 aset->G_DTX[i]=aset->G_DTX[i-1];
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2605
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2606 aset->G_DTX[0]=tab_ptr[0];
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2607 }
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2608
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2609 /* Computation of MAX{G_all[i],G_DTX[j]} i,j=0..3 */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2610 #if DPAGC_MAX_FLAG
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2611 max_G_all = l1ctl_find_max(&(tab_ptr[0]),DPAGC_FIFO_LEN);
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2612
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2613 if (!beacon)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2614 {
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2615 max_G_DTX = l1ctl_find_max(&(aset->G_DTX[0]),DPAGC_FIFO_LEN);
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2616
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2617 // WARNING: for array index purpose we work with POSITIVE input level
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2618 // so maximum search for negative numbers is equivalent to
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2619 // minimum search for positive numbers!!!!!!
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2620 // (-30 > -120 but 30 < 120)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2621 if (max_G_all <= max_G_DTX)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2622 new_IL = max_G_all;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2623 else
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2624 new_IL = max_G_DTX;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2625 }
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2626 else
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2627 new_IL = max_G_all;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2628 #else
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2629 av_G_all=av_G_DTX=0;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2630
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2631 for (i=0;i<DPAGC_FIFO_LEN;i++)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2632 av_G_all += tab_ptr[i];
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2633
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2634 av_G_all /= DPAGC_FIFO_LEN;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2635
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2636 if (!beacon)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2637 {
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2638 for (i=0;i<DPAGC_FIFO_LEN;i++)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2639 av_G_DTX += aset->G_DTX[i];
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2640
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2641 av_G_DTX /= DPAGC_FIFO_LEN;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2642
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2643 if (av_G_all >= av_G_DTX)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2644 new_IL = av_G_all;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2645 else
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2646 new_IL = av_G_DTX;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2647 }
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2648 else
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2649 new_IL = av_G_all;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2650 #endif
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2651
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2652 // Updating of input_level and lna_off fields in order to correctly
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2653 // setting the AGC for the next task.
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2654 // input_level is always store with lna_on
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2655 l1ctl_encode_lna( (UWORD8)(current_calibrated_IL>>1),
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2656 &(IL_info_ptr->lna_off),
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2657 radio_freq );
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2658
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2659 IL_info_ptr->input_level = (UWORD8)new_IL ;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2660
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2661 #if L2_L3_SIMUL
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2662 #if (DEBUG_TRACE==BUFFER_TRACE_DPAGC)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2663 buffer_trace(4,IL_info_ptr->input_level,last_known_agc,
82 ef6cf21cf9d6 l1_ctl.c: passes compilation, but doesn't match old object yet Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 81 diff changeset	2664 l1a_l1s_com.Scell_used_IL_dd.input_level,Cust_get_agc_from_IL(radio_freq, new_IL >> 1, MAX_ID));
80 6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2665 #endif
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2666 #endif
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2667
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2668 return((UWORD8)current_calibrated_IL);
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2669 }
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2670
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2671 #if (AMR == 1)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2672 /-------------------------------------------------------/
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2673 /* l1ctl_dpagc_amr() */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2674 /-------------------------------------------------------/
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2675 /* Description : */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2676 /* =========== */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2677 /* Based on the same principle as the one used for DPAGC */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2678 /* algorithm except that the way to feed the G_dtx is */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2679 /* different */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2680 /-------------------------------------------------------/
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2681 UWORD8 l1ctl_dpagc_amr(BOOL dtx_on, BOOL beacon, UWORD8 pm, UWORD16 radio_freq, T_INPUT_LEVEL *IL_info_ptr)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2682 {
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2683 UWORD8 av_G_all, av_G_DTX;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2684 UWORD8 max_G_all, max_G_DTX, max_il;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2685 WORD32 last_known_agc, new_IL, current_calibrated_IL;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2686 WORD8 delta1_freq, delta2_freq;
81 6124f48fc1fa l1_ctl.c: fixes from the freecalypso-sw/gsm-fw version Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 80 diff changeset	2687 WORD16 delta_drp_gain=0;
80 6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2688 UWORD8 i;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2689 UWORD8 tab_ptr, tab_amr_ptr;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2690 T_DEDIC_SET *aset;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2691 WORD32 lna_value;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2692 UWORD16 arfcn;
81 6124f48fc1fa l1_ctl.c: fixes from the freecalypso-sw/gsm-fw version Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 80 diff changeset	2693 UWORD8 lna_off;
80 6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2694 UWORD16 dco_algo_ctl_pw_temp = 0;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2695 UWORD8 if_ctl = 0;
81 6124f48fc1fa l1_ctl.c: fixes from the freecalypso-sw/gsm-fw version Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 80 diff changeset	2696 #if (RF_RAM == 61) && (CODE_VERSION != SIMULATION)
80 6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2697 UWORD8 if_threshold = C_IF_ZERO_LOW_THRESHOLD_GSM;
81 6124f48fc1fa l1_ctl.c: fixes from the freecalypso-sw/gsm-fw version Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 80 diff changeset	2698 #endif
80 6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2699
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2700 delta1_freq = l1ctl_encode_delta1(radio_freq);
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2701 delta2_freq = l1ctl_encode_delta2(radio_freq);
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2702
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2703 aset = l1a_l1s_com.dedic_set.aset;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2704
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2705 if (beacon)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2706 tab_ptr = l1a_l1s_com.Scell_info.buff_beacon;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2707 else
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2708 tab_ptr = aset->G_all;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2709
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2710 // Update fifo
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2711 for (i=DPAGC_FIFO_LEN-1;i>0;i--)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2712 tab_ptr[i]=tab_ptr[i-1];
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2713
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2714 tab_amr_ptr = aset->G_amr;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2715 for (i=DPAGC_AMR_FIFO_LEN-1;i>0;i--)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2716 tab_amr_ptr[i]=tab_amr_ptr[i-1];
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2717
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2718 #if TESTMODE
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2719 if (!l1_config.agc_enable)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2720 {
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2721 // AGC gain can only be controlled in 2dB steps as the bottom bit (bit zero)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2722 // corresponds to the lna_off bit
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2723 last_known_agc = (l1_config.tmode.rx_params.agc) << 1;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2724 lna_value = (l1_config.tmode.rx_params.lna_off) * l1ctl_get_lna_att(radio_freq);
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2725 }
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2726 else
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2727 #endif
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2728 {
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2729 #if DPAGC_MAX_FLAG
82 ef6cf21cf9d6 l1_ctl.c: passes compilation, but doesn't match old object yet Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 81 diff changeset	2730 last_known_agc = (Cust_get_agc_from_IL(radio_freq, l1a_l1s_com.Scell_used_IL_dd.input_level >> 1, MAX_ID)) << 1;
80 6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2731 // F7.1 in order to be compatible with pm and IL formats
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2732 #else
82 ef6cf21cf9d6 l1_ctl.c: passes compilation, but doesn't match old object yet Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 81 diff changeset	2733 last_known_agc = (Cust_get_agc_from_IL(radio_freq, l1a_l1s_com.Scell_used_IL_dd.input_level >> 1, AV_ID)) << 1;
80 6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2734 // F7.1 in order to be compatible with pm and IL formats
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2735 #endif
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2736 // input_level_dd : contain the input_level value we use
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2737 // in the associated CTL task to build the agc used in this CTL.
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2738
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2739 lna_value = l1a_l1s_com.Scell_used_IL_dd.lna_off * l1ctl_get_lna_att(radio_freq);
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2740 }
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2741
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2742 #if (L1_FF_MULTIBAND == 0)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2743 arfcn = Convert_l1_radio_freq(radio_freq);
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2744 #else
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2745 arfcn=radio_freq;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2746 #endif
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2747
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2748 #if(RF_FAM == 61)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2749 #if (CODE_VERSION != SIMULATION)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2750 cust_get_if_dco_ctl_algo(&dco_algo_ctl_pw_temp, &if_ctl, (UWORD8) L1_IL_VALID ,
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2751 l1a_l1s_com.Scell_used_IL_dd.input_level,
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2752 radio_freq,if_threshold);
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2753 lna_off = l1a_l1s_com.Scell_used_IL_dd.lna_off;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2754 delta_drp_gain = drp_gain_correction(arfcn, lna_off, last_known_agc); // F7.1 format
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2755 if(if_ctl == IF_100KHZ_DSP){
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2756 delta_drp_gain += SCF_ATTENUATION_LIF_100KHZ;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2757 }
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2758 else{ /* i.e. if_ctl = IF_120KHZ_DSP*/
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2759 delta_drp_gain += SCF_ATTENUATION_LIF_120KHZ;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2760 }
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2761 #endif
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2762 #endif
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2763
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2764 if (0==pm) // Check and filter illegal pm value by using last valid IL
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2765 new_IL = IL_info_ptr->input_level;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2766 else
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2767 new_IL = -(pm - (last_known_agc - delta_drp_gain) + lna_value - l1ctl_get_g_magic(radio_freq));
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2768
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2769 current_calibrated_IL = new_IL - delta1_freq - delta2_freq;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2770
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2771 // Protect IL stores against overflow
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2772 if (current_calibrated_IL>INDEX_MAX)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2773 current_calibrated_IL=INDEX_MAX;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2774
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2775 #if TESTMODE
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2776 if (l1tm.tmode_state.dedicated_active) // Implies l1_config.TestMode = 1
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2777 {
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2778 // Update l1tm.tmode_stats.rssi_fifo (delay line from index 3 to 0)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2779 for (i=(sizeof(l1tm.tmode_stats.rssi_fifo)/sizeof(l1tm.tmode_stats.rssi_fifo[0]))-1; i>0; i--)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2780 {
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2781 l1tm.tmode_stats.rssi_fifo[i] = l1tm.tmode_stats.rssi_fifo[i-1];
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2782 }
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2783 l1tm.tmode_stats.rssi_fifo[0] = current_calibrated_IL; // rssi value is F7.1
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2784 l1tm.tmode_stats.rssi_recent = current_calibrated_IL; // rssi value is F7.1
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2785 }
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2786 #endif
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2787
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2788 if (new_IL>INDEX_MAX)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2789 new_IL=INDEX_MAX;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2790
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2791 tab_ptr[0] = (UWORD8)new_IL;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2792 tab_amr_ptr[0] = (UWORD8)new_IL;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2793
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2794 if (dtx_on && !beacon)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2795 {
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2796 // a new AMR block is received, feed the G_dtx with the max_il of the block
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2797 for (i=DPAGC_FIFO_LEN-1;i>0;i--)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2798 aset->G_DTX[i]=aset->G_DTX[i-1];
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2799
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2800 if (l1a_l1s_com.dedic_set.aset->achan_ptr->mode == TCH_AHS_MODE)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2801 {
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2802 // Keep the max_il between the last 2 bursts
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2803 if (aset->G_amr[0] > aset->G_amr[1])
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2804 max_il = aset->G_amr[0];
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2805 else
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2806 max_il = aset->G_amr[1];
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2807 }
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2808 else
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2809 {
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2810 // Keep the max_il between the last 4 bursts
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2811 max_il = l1ctl_find_max(&aset->G_amr[0], DPAGC_AMR_FIFO_LEN);
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2812 }
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2813
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2814 aset->G_DTX[0]= max_il;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2815 }
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2816
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2817 /* Computation of MAX{G_all[i],G_DTX[j]} i,j=0..3 */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2818 #if DPAGC_MAX_FLAG
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2819 max_G_all = l1ctl_find_max(&(tab_ptr[0]),DPAGC_FIFO_LEN);
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2820
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2821 if (!beacon)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2822 {
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2823 max_G_DTX = l1ctl_find_max(&(aset->G_DTX[0]),DPAGC_FIFO_LEN);
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2824
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2825 // WARNING: for array index purpose we work with POSITIVE input level
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2826 // so maximum search for negative numbers is equivalent to
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2827 // minimum search for positive numbers!!!!!!
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2828 // (-30 > -120 but 30 < 120)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2829 if (max_G_all <= max_G_DTX)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2830 new_IL = max_G_all;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2831 else
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2832 new_IL = max_G_DTX;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2833 }
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2834 else
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2835 new_IL = max_G_all;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2836 #else
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2837 av_G_all=av_G_DTX=0;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2838
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2839 for (i=0;i<DPAGC_FIFO_LEN;i++)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2840 av_G_all += tab_ptr[i];
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2841
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2842 av_G_all /= DPAGC_FIFO_LEN;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2843
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2844 if (!beacon)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2845 {
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2846 for (i=0;i<DPAGC_FIFO_LEN;i++)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2847 av_G_DTX += aset->G_DTX[i];
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2848
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2849 av_G_DTX /= DPAGC_FIFO_LEN;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2850
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2851 if (av_G_all >= av_G_DTX)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2852 new_IL = av_G_all;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2853 else
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2854 new_IL = av_G_DTX;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2855 }
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2856 else
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2857 new_IL = av_G_all;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2858 #endif
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2859
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2860 // Updating of input_level and lna_off fields in order to correctly
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2861 // setting the AGC for the next task.
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2862 // input_level is always store with lna_on
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2863
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2864 l1ctl_encode_lna( (UWORD8)(current_calibrated_IL>>1),
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2865 &(IL_info_ptr->lna_off),
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2866 radio_freq );
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2867 IL_info_ptr->input_level = (UWORD8)new_IL ;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2868
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2869 #if L2_L3_SIMUL
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2870 #if (DEBUG_TRACE==BUFFER_TRACE_DPAGC)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2871 buffer_trace(4,IL_info_ptr->input_level,last_known_agc,
82 ef6cf21cf9d6 l1_ctl.c: passes compilation, but doesn't match old object yet Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 81 diff changeset	2872 l1a_l1s_com.Scell_used_IL_dd.input_level,Cust_get_agc_from_IL(radio_freq, new_IL >> 1, MAX_ID));
80 6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2873 #endif
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2874 #endif
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2875
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2876 return((UWORD8)current_calibrated_IL);
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2877 }
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2878 #endif // AMR == 1
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2879
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2880 /-------------------------------------------------------/
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2881 /* l1ctl_get_g_magic() */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2882 /-------------------------------------------------------/
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2883 /* Parameters : */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2884 /* Return : */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2885 /* Functionality : */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2886 /-------------------------------------------------------/
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2887 #if (L1_FF_MULTIBAND == 0)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2888 UWORD16 l1ctl_get_g_magic(UWORD16 radio_freq)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2889 {
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2890
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2891
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2892 if ((l1_config.std.id == DUAL) \|\| (l1_config.std.id == DUALEXT) \|\| (l1_config.std.id == DUAL_US))
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2893 {
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2894 if (radio_freq >= l1_config.std.first_radio_freq_band2)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2895 return(l1_config.std.g_magic_band2);
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2896 else
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2897 return(l1_config.std.g_magic_band1);
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2898 }
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2899 else
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2900 return(l1_config.std.g_magic_band1);
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2901
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2902
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2903 }
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2904 #endif
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2905
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2906 /-------------------------------------------------------/
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2907 /* l1ctl_get_lna_att() */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2908 /-------------------------------------------------------/
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2909 /* Parameters : */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2910 /* Return : */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2911 /* Functionality : */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2912 /-------------------------------------------------------/
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2913 #if (L1_FF_MULTIBAND == 0)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2914 UWORD16 l1ctl_get_lna_att(UWORD16 radio_freq)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2915 {
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2916
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2917
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2918 if ((l1_config.std.id == DUAL) \|\| (l1_config.std.id == DUALEXT) \|\| (l1_config.std.id == DUAL_US))
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2919 {
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2920 if (radio_freq >= l1_config.std.first_radio_freq_band2)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2921 return(l1_config.std.lna_att_band2);
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2922 else
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2923 return(l1_config.std.lna_att_band1);
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2924 }
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2925 else
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2926 return(l1_config.std.lna_att_band1);
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2927
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2928
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2929 }
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2930 #endif
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2931 /-------------------------------------------------------/
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2932 /* l1ctl_update_TPU_with_toa() */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2933 /-------------------------------------------------------/
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2934 /* Parameters : */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2935 /* Return : */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2936 /* Functionality : */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2937 /-------------------------------------------------------/
82 ef6cf21cf9d6 l1_ctl.c: passes compilation, but doesn't match old object yet Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 81 diff changeset	2938 void l1ctl_update_TPU_with_toa(void)
80 6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2939 {
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2940 #if (TOA_ALGO != 0)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2941 WORD16 toa_shift;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2942
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2943 #if (TOA_ALGO == 2)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2944 toa_shift = l1s.toa_var.toa_shift;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2945 #else
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2946 toa_shift = l1s.toa_shift;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2947 #endif
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2948
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2949 if (toa_shift != ISH_INVALID)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2950 // New ISH (TOA shift) has been stored in "l1s.toa_shift".
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2951 {
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2952 // NEW !!! For EOTD measurements in IDLE mode, cut AFC updates...
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2953 #if (L1_EOTD==1)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2954 #if (L1_GPRS)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2955 if ( (l1a_l1s_com.nsync.eotd_meas_session == FALSE) \|\|
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2956 (l1a_l1s_com.mode == DEDIC_MODE)\|\|
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2957 (l1a_l1s_com.l1s_en_task[PDTCH] == TASK_ENABLED))
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2958 #else
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2959 if ( (l1a_l1s_com.nsync.eotd_meas_session == FALSE) \|\|
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2960 (l1a_l1s_com.mode == DEDIC_MODE))
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2961 #endif
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2962 {
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2963 // In dedicated or transfer modes we need to track an TOA
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2964 // updates to post correct th results, else E-OTD implementation
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2965 // has qb errors...
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2966
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2967 if( (l1a_l1s_com.nsync.eotd_meas_session == TRUE)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2968 && (l1a_l1s_com.nsync.eotd_toa_phase == 1) )
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2969 {
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2970 l1a_l1s_com.nsync.eotd_toa_tracking += toa_shift;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2971 }
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2972 #endif
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2973 // Update tpu offset.
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2974 l1s.tpu_offset = (l1s.tpu_offset + TPU_CLOCK_RANGE + toa_shift) % TPU_CLOCK_RANGE;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2975
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2976 #if (TRACE_TYPE==1) \|\| (TRACE_TYPE==4)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2977 #if (GSM_IDLE_RAM == 0)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2978 l1_trace_new_toa();
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2979 #else
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2980 l1_trace_new_toa_intram();
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2981 #endif
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2982 #endif
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2983
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2984 #if (L1_EOTD==1)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2985 }
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2986 #endif
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2987
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2988 #if (TRACE_TYPE == 5)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2989 #if (TOA_ALGO == 2)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2990 trace_toa_sim_update (toa_shift,l1s.tpu_offset);
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2991 #endif
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2992 #endif
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2993
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2994 // Reset ISH.
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2995 #if (TOA_ALGO == 2)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2996 l1s.toa_var.toa_shift = ISH_INVALID; // Reset the ISH.
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2997 #else
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2998 l1s.toa_shift = ISH_INVALID; // Reset the ISH.
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	2999 #endif
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	3000 }
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	3001 #endif
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	3002 }
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	3003
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	3004
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	3005 /-------------------------------------------------------/
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	3006 /* l1ctl_saic() */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	3007 /-------------------------------------------------------/
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	3008 /* Parameters : */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	3009 /* Return : */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	3010 /* Functionality : */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	3011 /-------------------------------------------------------/
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	3012
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	3013 #if (L1_SAIC != 0)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	3014 #define SWH_CHANTAP_INIT 0xFFD068CE
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	3015 #if (NEW_SNR_THRESHOLD == 1)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	3016 UWORD8 l1ctl_saic (UWORD8 IL_for_rxlev, UWORD32 l1_mode, UWORD8 task, UWORD8 * saic_flag)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	3017 #else
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	3018 UWORD8 l1ctl_saic (UWORD8 IL_for_rxlev, UWORD32 l1_mode)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	3019 #endif /* NEW_SNR_THRESHOLD */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	3020 {
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	3021 UWORD16 SWH_flag = 0;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	3022 UWORD8 CSF_Filter_choice = L1_SAIC_HARDWARE_FILTER;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	3023 #if (NEW_SNR_THRESHOLD == 0)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	3024 volatile UWORD16 *ptr;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	3025 UWORD8 saic_flag;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	3026 #endif /* NEW_SNR_THRESHOLD */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	3027 #if (NEW_SNR_THRESHOLD == 0)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	3028 ptr = (volatile UWORD16 * ) (SWH_CHANTAP_INIT);
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	3029 *ptr = 0;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	3030 saic_flag=1;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	3031 #else
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	3032 *saic_flag=0;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	3033 #endif
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	3034
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	3035 switch (l1_mode)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	3036 {
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	3037 case DEDIC_MODE: // GSM DEDICATED MODE
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	3038 {
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	3039 #if (NEW_SNR_THRESHOLD == 1)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	3040 *saic_flag=1;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	3041 #endif
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	3042 if(IL_for_rxlev < L1_SAIC_GENIE_GSM_DEDIC_THRESHOLD)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	3043 {
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	3044 SWH_flag=1;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	3045 }
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	3046
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	3047 break;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	3048 }
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	3049 #if L1_GPRS
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	3050 case PACKET_TRANSFER_MODE: // PACKET TRANSFER MODE
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	3051 {
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	3052 #if (NEW_SNR_THRESHOLD == 0)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	3053 #if (L1_SAIC == 1)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	3054 if(IL_for_rxlev < L1_SAIC_GENIE_GPRS_PCKT_TRAN_THRESHOLD)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	3055 {
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	3056 *ptr = 4;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	3057 }
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	3058 #endif /#if (L1_SAIC == 3)/
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	3059 #endif
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	3060
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	3061 #if (L1_SAIC == 3)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	3062 if(IL_for_rxlev < L1_SAIC_GENIE_GPRS_PCKT_TRAN_THRESHOLD)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	3063 {
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	3064 SWH_flag = 1;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	3065 }
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	3066 #endif /#if (L1_SAIC == 3)/
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	3067 break;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	3068 }
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	3069 #endif /#if L1_GPRS/
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	3070 default: /* GSM OR GPRS IDLE MODES */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	3071 {
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	3072 #if ((L1_SAIC == 2)\|\|(L1_SAIC == 3))
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	3073 if(IL_for_rxlev < L1_SAIC_GENIE_GSM_GPRS_IDLE_THRESHOLD)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	3074 {
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	3075 SWH_flag=1;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	3076 }
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	3077 #endif
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	3078 break;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	3079 }
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	3080 }
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	3081
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	3082 l1ddsp_load_swh_flag (SWH_flag ,
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	3083 #if (NEW_SNR_THRESHOLD == 0)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	3084 saic_flag
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	3085 #else
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	3086 *saic_flag
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	3087 #endif
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	3088 );
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	3089
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	3090 if(SWH_flag == 1)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	3091 {
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	3092 CSF_Filter_choice = L1_SAIC_PROGRAMMABLE_FILTER;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	3093 }
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	3094
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	3095
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	3096 #if (TRACE_TYPE == 1) \|\| (TRACE_TYPE == 4)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	3097 l1_trace_saic(SWH_flag,
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	3098 #if (NEW_SNR_THRESHOLD == 0)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	3099 saic_flag
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	3100 #else
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	3101 *saic_flag
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	3102 #endif
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	3103 );
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	3104 #endif
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	3105 #if (TRACE_TYPE == 5)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	3106 trace_saic_sim(IL_for_rxlev, l1_mode, SWH_flag);
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	3107 #endif
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	3108
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	3109 return(CSF_Filter_choice);
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	3110 }
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	3111 #endif
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	3112
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	3113 #if (FF_L1_FAST_DECODING == 1)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	3114 /-----------------------------------------------------------------/
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	3115 /* l1ctl_pagc_missing_bursts */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	3116 /-----------------------------------------------------------------/
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	3117 /* */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	3118 /* Description: */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	3119 /* ------------ */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	3120 /* When fast decoding is active, fewer bursts are decoded. As a */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	3121 /* result, fewer gain values are available. The PAGC algo must */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	3122 /* be updated with the missed values. */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	3123 /* */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	3124 /* Input parameters: */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	3125 /* ----------------- */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	3126 /* UWORD8 skipped_values: the number of skipped bursts due to fast */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	3127 /* decoding. */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	3128 /* */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	3129 /* Input parameters from globals: */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	3130 /* ------------------------------ */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	3131 /* l1a_l1s_com.Scell_info.buff_beacon: Input Level (IL) FIFO */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	3132 /* l1_config.params.il_min: minimum level */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	3133 /* */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	3134 /* Output parameters: */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	3135 /* ------------------ */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	3136 /* none */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	3137 /* */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	3138 /* Modified parameters from globals: */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	3139 /* --------------------------------- */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	3140 /* l1a_l1s_com.Scell_info.buff_beacon: Input Level (IL) FIFO */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	3141 /* */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	3142 /-----------------------------------------------------------------/
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	3143
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	3144 void l1ctl_pagc_missing_bursts (UWORD8 skipped_values)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	3145 {
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	3146 UWORD8 i = 0;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	3147
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	3148 /* skipped_values cannot be greater than 3, otherwise this is an error
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	3149 * and the PAGC algorithm mustn't be updated. */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	3150 if (skipped_values > 3)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	3151 {
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	3152 return;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	3153 }
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	3154
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	3155 /* Update fifo by removing skipped_values of samples */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	3156 for (i = 3; i > (skipped_values - 1); i--)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	3157 {
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	3158 l1a_l1s_com.Scell_info.buff_beacon[i] = l1a_l1s_com.Scell_info.buff_beacon[i-skipped_values];
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	3159 }
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	3160
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	3161 /* Insert minimum IL level as many times a burst has been skipped */
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	3162 for (i = 0; i < skipped_values; i++)
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	3163 {
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	3164 l1a_l1s_com.Scell_info.buff_beacon[i] = l1_config.params.il_min;
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	3165 }
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	3166 }
6c740cf30da3 l1_ctl.c: initial import of LoCosto source Mychaela Falconia <falcon@ivan.Harhan.ORG> parents: 15 diff changeset	3167 #endif /* #if (FF_L1_FAST_DECODING == 1) */

FreeCalypso > hg > tcs211-l1-reconst

annotate chipsetsw/layer1/cfile/l1_ctl.c @ 82:ef6cf21cf9d6