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

annotate src/cs/layer1/cfile/l1_pwmgr.c @ 702:9394305d4ff5 default tip

etm_audio.c: fix off-by-one error in auw of FIR coefficients This fix was already made in FC Tourmaline a while back, but it is also the kind of bugfix that deserves to be backported to Magnetite and Selenite as well.

author	Mychaela Falconia <falcon@freecalypso.org>
date	Mon, 31 Oct 2022 00:14:44 +0000
parents	b24d42baa30d
children

rev	line source
69 50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1 /*********** Revision Controle System Header ***********
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2 * GSM Layer 1 software
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	3 * L1_PWMGR.C
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	4 *
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	5 * Filename l1_pwmgr.c
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	6 * Copyright 2003 (C) Texas Instruments
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	7 *
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	8 *********** Revision Controle System Header ***********/
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	9
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	10 #define L1_PWMGR_C
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	11 //#pragma DUPLICATE_FOR_INTERNAL_RAM_START
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	12
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	13 #include "timer/timer2.h"
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	14 #include "armio/armio.h"
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	15
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	16 //omaps00090550 #include "l1_macro.h"
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	17 #include "l1_confg.h"
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	18
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	19 #if (OP_L1_STANDALONE == 1)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	20 #include "uart/serialswitch_core.h"
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	21 #else
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	22 #include "uart/serialswitch.h"
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	23 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	24
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	25 #if (OP_L1_STANDALONE == 0)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	26 #include "sim/sim.h"
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	27 #include "rv_swe.h"
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	28 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	29
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	30
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	31 #if (CODE_VERSION == SIMULATION)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	32 #include "l1_types.h"
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	33 #include "l1_const.h"
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	34
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	35 #if (CHIPSET == 12) \|\| (CHIPSET == 15)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	36 #include "inth/sys_inth.h"
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	37 #include "sys_dma.h"
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	38 #include "ulpd.h"
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	39 #include "clkm.h"
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	40
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	41 // typedef volatile unsigned short REG_UWORD16; //omaps00090550
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	42 #define REG16(A) ((REG_UWORD16)(A))
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	43
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	44 #else
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	45 #include "inth/iq.h"
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	46 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	47
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	48 #if TESTMODE
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	49 #include "l1tm_defty.h"
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	50 #endif // TESTMODE
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	51
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	52 #if (AUDIO_TASK == 1)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	53 #include "l1audio_const.h"
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	54 #include "l1audio_cust.h"
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	55 #include "l1audio_defty.h"
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	56 #endif // AUDIO_TASK
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	57
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	58 #if (L1_GTT == 1)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	59 #include "l1gtt_const.h"
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	60 #include "l1gtt_defty.h"
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	61 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	62
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	63 #if (L1_MP3 == 1)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	64 #include "l1mp3_defty.h"
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	65 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	66
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	67 #if (L1_MIDI == 1)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	68 #include "l1midi_defty.h"
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	69 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	70 //ADDED FOR AAC
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	71 #if (L1_AAC == 1)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	72 #include "l1aac_defty.h"
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	73 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	74 #include "l1_defty.h"
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	75 #include "l1_varex.h"
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	76 #include "l1_tabs.h"
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	77 #include "cust_os.h"
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	78 #include "l1_msgty.h"
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	79 #include "l1_proto.h"
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	80 #include "ulpd.h"
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	81 #include "l1_trace.h"
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	82
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	83 #if L1_GPRS
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	84 #include "l1p_cons.h"
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	85 #include "l1p_msgt.h"
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	86 #include "l1p_deft.h"
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	87 #include "l1p_vare.h"
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	88 #endif // L1_GPRS
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	89
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	90 #include <stdio.h>
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	91 #include "sim_cfg.h"
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	92 #include "sim_cons.h"
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	93 #include "sim_def.h"
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	94 #include "sim_var.h"
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	95 //omaps00090550
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	96 #include "nucleus.h"
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	97
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	98 extern NU_TASK L1S_task;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	99 STATUS status;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	100
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	101
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	102
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	103 #else // NO SIMULATION
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	104
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	105
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	106
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	107 #include "l1_types.h"
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	108 #include "l1_const.h"
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	109
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	110 #include "abb/abb.h"
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	111 #include "dma/sys_dma.h"
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	112
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	113 #if (OP_BT == 1)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	114 #include "hci_ll_simul.h"
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	115 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	116
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	117 #if TESTMODE
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	118 #include "l1tm_defty.h"
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	119 #endif // TESTMODE
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	120
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	121 #if (AUDIO_TASK == 1)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	122 #include "l1audio_const.h"
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	123 #include "l1audio_cust.h"
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	124 #include "l1audio_defty.h"
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	125 #endif // AUDIO_TASK
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	126
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	127 #if (L1_GTT == 1)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	128 #include "l1gtt_const.h"
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	129 #include "l1gtt_defty.h"
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	130 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	131
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	132 #if (L1_MP3 == 1)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	133 #include "l1mp3_defty.h"
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	134 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	135
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	136 #if (L1_MIDI == 1)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	137 #include "l1midi_defty.h"
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	138 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	139 //ADDED FOR AAC
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	140 #if (L1_AAC == 1)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	141 #include "l1aac_defty.h"
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	142 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	143 #include "l1_defty.h"
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	144 #include "l1_varex.h"
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	145 #include "l1_tabs.h"
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	146 #include "sys_types.h"
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	147 #include "tpudrv.h"
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	148 #include "cust_os.h"
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	149 #include "l1_msgty.h"
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	150 #include "l1_proto.h"
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	151 #include "l1_trace.h"
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	152 #include "timer/timer.h"
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	153
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	154 #if (CHIPSET == 12) \|\| (CHIPSET == 15)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	155 #include "timer/timer_sec.h"
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	156 #include "inth/sys_inth.h"
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	157
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	158 /* FreeCalypso: massive #if (CHIPSET == 15) chunk removed */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	159
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	160 #else //(CHIPSET == 12) \|\| (CHIPSET == 15)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	161 #include "inth/iq.h"
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	162 #include "inth/inth.h"
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	163 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	164 // #include "timer1.h"
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	165 #include "ulpd/ulpd.h"
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	166 #include "clkm/clkm.h"
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	167 #include "memif/mem.h"
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	168 #if L2_L3_SIMUL
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	169 #include "hw_debug.h"
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	170 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	171
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	172 #if (OP_WCP == 1) && (OP_L1_STANDALONE != 1)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	173 #include "csmi/sleep.h"
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	174 #endif // OP_WCP
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	175 #if (W_A_CALYPSO_PLUS_SPR_19599 == 1)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	176 #include "sys_memif.h"
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	177 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	178
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	179 #if (GSM_IDLE_RAM != 0)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	180 #if (OP_L1_STANDALONE == 1)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	181 #include "csmi_simul.h"
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	182 #else
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	183 #include "csmi/csmi.h"
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	184 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	185 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	186
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	187 #if (CHIPSET == 15)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	188 #include "drp_api.h"
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	189 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	190
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	191 #endif // NO SIMULATION
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	192
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	193 #if (CODE_VERSION != SIMULATION)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	194 // for PTOOL compatibility
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	195 extern void INT_DisableIRQ(void);
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	196 extern void INT_EnableIRQ(void);
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	197 extern void l1dmacro_RF_sleep(void);
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	198 extern void l1dmacro_RF_wakeup(void);
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	199 WORD32 l1s_get_HWTimers_ticks(void);
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	200
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	201 // file timer1.h
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	202 SYS_UWORD16 Dtimer1_Get_cntlreg(void);
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	203 void Dtimer1_AR(unsigned short Ar);
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	204 void Dtimer1_PTV(unsigned short Ptv);
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	205 void Dtimer1_Clken(unsigned short En);
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	206 void Dtimer1_Start (unsigned short startStop);
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	207 void Dtimer1_Init_cntl (SYS_UWORD16 St, SYS_UWORD16 Reload, SYS_UWORD16 clockScale, SYS_UWORD16 clkon);
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	208 SYS_UWORD16 Dtimer1_WriteValue (SYS_UWORD16 value);
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	209 SYS_UWORD16 Dtimer1_ReadValue (void);
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	210 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	211
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	212 void l1s_wakeup(void);
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	213 BOOL l1s_compute_wakeup_ticks(void);
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	214 void l1s_recover_Frame(void);
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	215 UWORD8 Cust_recover_Os(void);
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	216 void l1s_recover_HWTimers(void);
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	217 UWORD8 Cust_check_system(void);
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	218 void f_arm_sleep_cmd(UWORD8 d_sleep_mode);
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	219
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	220 //#if (TRACE_TYPE == 2) \|\| (TRACE_TYPE == 3)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	221 extern void L1_trace_string(char *s);
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	222 extern void L1_trace_char (char s);
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	223 //#endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	224 extern UWORD16 slp_debug_flag;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	225
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	226 #if (GSM_IDLE_RAM != 0)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	227 extern void l1s_trace_mftab(void);
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	228 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	229
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	230 #if (CODE_VERSION != SIMULATION) && (CHIPSET == 15)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	231 extern T_DRP_REGS_STR *drp_regs;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	232 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	233
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	234 #if L1_GPRS
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	235 WORD32 l1s_get_next_gauging_in_Packet_Idle(void);
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	236 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	237 //#pragma DUPLICATE_FOR_INTERNAL_RAM_END
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	238
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	239 #if !((MOVE_IN_INTERNAL_RAM == 1) && (GSM_IDLE_RAM !=0)) // MOVE TO INTERNAL MEM IN CASE GSM_IDLE_RAM enabled
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	240 //#pragma GSM_IDLE_DUPLICATE_FOR_INTERNAL_RAM_START // KEEP IN EXTERNAL MEM otherwise
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	241
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	242 /************************************************************/
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	243 /* Macros for power management */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	244 /************************************************************/
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	245 #define MIN(min, operand1) \
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	246 if (operand1 <= min) min = operand1;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	247
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	248 // ex: RATIO T32khz/T4.33Mhz = 132.2428385417
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	249 // => root = integer part of the ratio
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	250 // = 132
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	251 // => frac = fractionnal part of the ratio multiplied by 65536 rounded to make it integer
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	252 // = 0.2428385417 * 65536 (Cf. ULPD specification)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	253 // = 0.2428385417 * 2^16
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	254 // = 15914.66666689 = 15914
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	255
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	256 #define RATIO(HF,LF, root, frac) \
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	257 root = (UWORD32)(HF/LF); \
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	258 frac = (UWORD32)(((HF - (root*LF)) << 16) / LF);
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	259
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	260 // previous ratio with frac + 0.5
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	261 #if 0 /* original LoCosto code */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	262 #define RATIO2(HF,LF, root, frac) \
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	263 if(LF){ \
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	264 root = (UWORD32)(HF/LF); \
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	265 frac = (UWORD32)((((HF - (rootLF)) << 16) + 0.5LF) / LF);}
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	266 #else /* FreeCalypso TCS211 reconstruction */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	267 #define RATIO2(HF,LF, root, frac) \
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	268 { \
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	269 root = (UWORD32)(HF/LF); \
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	270 frac = (UWORD32)((((HF - (rootLF)) << 16) + 0.5LF) / LF);}
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	271 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	272
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	273 #define HFTHEO(LF, root, frac, hftheo) \
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	274 hftheo = rootLF + ((fracLF) >>16);
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	275
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	276 #define SUM(HF, LF, nb, ind) \
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	277 LF=HF=0; \
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	278 for(ind=0; ind<nb; ind++) \
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	279 { \
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	280 LF = LF +l1s.pw_mgr.histo[ind][0]; \
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	281 HF = HF +l1s.pw_mgr.histo[ind][1]; \
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	282 }
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	283
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	284
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	285 #if 0 /* FreeCalypso TCS211 reconstruction */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	286 T_PWMGR_DEBUG l1_pwmgr_debug;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	287 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	288
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	289
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	290 /* FreeCalypso: massive #if (CHIPSET == 15) chunk removed */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	291
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	292
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	293 // l1ctl_pgm_clk32()
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	294 // convert ratio in 4.33Mhz and pgm INC_FRAC,INC_SIXTEEN.
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	295
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	296 void l1ctl_pgm_clk32(UWORD32 nb_hf, UWORD32 nb_32khz)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	297 {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	298 #if (CODE_VERSION != SIMULATION)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	299 if (l1_config.pwr_mngt == PWR_MNGT)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	300 {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	301 UWORD32 inc_sixteen= 0, inc_frac=0, lf;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	302
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	303 // REM: nb_hf is the real value of the high frequency (ex in nbr of 65Mhz clock)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	304 // To compute the ratio, nb_hf must be expressed in nbr of clock 4.33 Mhz
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	305 // that's why nb_hf is divided by 3*l1_config.dpll
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	306 // RATIO2(nb_hf/(3*l1_config.dpll),nb_32khz,inc_sixteen,inc_frac);
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	307 // this line above is equal to the ligne below:
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	308 lf=(UWORD32)(3l1_config.dpllnb_32khz);
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	309 RATIO2(nb_hf,lf,inc_sixteen,inc_frac);
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	310
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	311 // integer part
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	312 ULDP_INCSIXTEEN_UPDATE(inc_sixteen);
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	313
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	314 // fractional part
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	315 ULDP_INCFRAC_UPDATE(inc_frac);
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	316 }
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	317 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	318 }
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	319
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	320
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	321 // l1ctl_gauging()
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	322 // Description: management of the gauging results
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	323 // At RESET state reset histogram and then go to INIT.
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	324 // At INIT state, go back to RESET on each */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	325 // gauging > +- 100 ppm. If NB_INIT good gauging go to ACQUIS state.
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	326 // At ACQUIS state, go back to RESET on each gauging > (+- 20ppm +- 1us). If NB_ACQU good gauging */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	327 // go to UPDATE state. Allow deep sleep feature.
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	328 // At UPDATE state, count consecutive gauging >+- 1 us.
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	329 // If MAX_BAD_GAUGING results go back to RESET.
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	330 // Otherwise re-enable deep sleep feature and reset bad results counter.
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	331
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	332 void l1ctl_gauging ( UWORD32 nb_32khz, UWORD32 nb_hf)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	333 {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	334 if (l1_config.pwr_mngt == PWR_MNGT)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	335 {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	336 enum states
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	337 {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	338 RESET = 0,
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	339 INIT = 1,
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	340 ACQUIS = 2,
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	341 UPDATE = 3
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	342 };
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	343
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	344 static UWORD8 bad_count; // bad gauging values
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	345 static UWORD8 gauging_state= RESET; // RESET,INIT, ACQUIS, UPDATE
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	346 static UWORD8 nb_gaug; // number of gauging in ACQUIS
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	347 static UWORD8 idx,i; // index
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	348 static UWORD32 root, frac; // ratio of HF and LF average
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	349 UWORD32 sumLF, sumHF; // sum of HF and LF counts
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	350 double nbHF_theo;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	351
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	352
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	353 // AFC or TEMPERATURE variation
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	354
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	355 //if ( (ABS( (WORD32)(l1s.pw_mgr.previous_afc-l1s.afc) ) > AFC_VARIATION) \|\|
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	356 // (ABS( (WORD32)(l1s.pw_mgr.previous_temp-l1s.afc) > TEMP_VARIATION) )
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	357 // gauging_state = RESET;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	358
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	359 // reset state machine if not in IDLE mode
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	360 #if L1_GPRS
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	361 if ((l1a_l1s_com.l1s_en_task[NP] != TASK_ENABLED) && (l1a_l1s_com.l1s_en_task[PNP] != TASK_ENABLED))
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	362 gauging_state = RESET;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	363 #else
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	364 if ((l1a_l1s_com.l1s_en_task[NP] != TASK_ENABLED) )
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	365 gauging_state = RESET;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	366
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	367 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	368
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	369 switch (gauging_state)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	370 {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	371
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	372 case RESET:
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	373 {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	374 UWORD8 i;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	375
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	376 // Reset Histogram
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	377 for (i=0; i < SIZE_HIST; i++)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	378 {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	379 l1s.pw_mgr.histo[i][0] = 0;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	380 l1s.pw_mgr.histo[i][1] = 0;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	381 }
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	382 idx = 0;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	383 l1s.pw_mgr.enough_gaug= FALSE; // forbid Deep sleep
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	384 gauging_state = INIT;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	385 nb_gaug = NB_INIT; // counter for ACQUIS state
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	386 bad_count = 0; // reset count of BAD gauging
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	387
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	388 #if (TRACE_TYPE != 0)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	389 l1_trace_gauging_reset();
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	390 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	391 }
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	392
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	393
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	394 case INIT:
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	395 {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	396
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	397 // Acquire NB_INIT gauging wtw +- 100 ppm
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	398
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	399 if (l1a_l1s_com.mode != I_MODE) return;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	400
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	401 // compute clocks ratio from measurements.
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	402 RATIO(nb_hf,nb_32khz,root,frac)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	403
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	404
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	405 // allow [-500ppm,+100ppm] derive on 32Khz at startup.
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	406 #if 0 /* really old code, apparently */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	407 if (
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	408 (root > l1s.pw_mgr.c_clk_min \|\|
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	409 (root == l1s.pw_mgr.c_clk_min &&
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	410 frac >= l1s.pw_mgr.c_clk_init_min) ) &&
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	411 (root < l1s.pw_mgr.c_clk_max \|\|
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	412 (root == l1s.pw_mgr.c_clk_max &&
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	413 frac <= l1s.pw_mgr.c_clk_init_max ) )
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	414 #elif 1 /* TCS211 reconstruction */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	415 if (
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	416 (root == l1s.pw_mgr.c_clk_min &&
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	417 frac >= l1s.pw_mgr.c_clk_init_min ) \|\|
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	418 (root == l1s.pw_mgr.c_clk_max &&
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	419 frac <= l1s.pw_mgr.c_clk_init_max )
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	420 #else /* LoCosto code */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	421 if (
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	422 ( l1s.pw_mgr.c_clk_min == l1s.pw_mgr.c_clk_max &&
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	423 frac >= l1s.pw_mgr.c_clk_init_min &&
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	424 frac <= l1s.pw_mgr.c_clk_init_max )
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	425 \|\|
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	426 ( l1s.pw_mgr.c_clk_min != l1s.pw_mgr.c_clk_max &&
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	427 ( (root == l1s.pw_mgr.c_clk_min &&
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	428 frac >= l1s.pw_mgr.c_clk_init_min ) \|\|
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	429 (root > l1s.pw_mgr.c_clk_min &&
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	430 root < l1s.pw_mgr.c_clk_max ) \|\|
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	431 (root == l1s.pw_mgr.c_clk_max &&
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	432 frac <= l1s.pw_mgr.c_clk_init_max ) ) )
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	433 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	434 )
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	435 {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	436 l1s.pw_mgr.histo[idx ][0] = nb_32khz; // init histo with the number of 32kHz
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	437 l1s.pw_mgr.histo[idx++][1] = nb_hf; // init histo with the number of hf (13Mhz)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	438
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	439 #if (CODE_VERSION == SIMULATION)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	440 #if (TRACE_TYPE==5)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	441 trace_ULPD("Gauging INIT Case ", l1s.actual_time.fn);
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	442 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	443 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	444
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	445 }
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	446 else
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	447 {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	448 // out of the allowed derive -> reset
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	449 idx=0;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	450 #if (TRACE_TYPE != 0)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	451 l1_trace_gauging_reset();
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	452 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	453 }
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	454
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	455 if (idx == NB_INIT)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	456 {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	457 // enough measurement -> ACQUIS state
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	458 gauging_state = ACQUIS;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	459 // compute clk ratio on count average
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	460 SUM(sumHF,sumLF, NB_INIT,i) // returns sumHF and sumLF
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	461 RATIO(sumHF,sumLF,root, frac) // returns root and frac*2E16, computed on the average
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	462 }
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	463 }
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	464 break;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	465
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	466
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	467 case ACQUIS:
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	468 {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	469 // Acquire NB_ACQU gauging at +-25ppm
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	470 // with jitter +- 1 us
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	471 UWORD8 n;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	472
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	473 // from nb_32khz "measured"
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	474 // compute nbHF_theo
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	475 HFTHEO(nb_32khz,root,frac,nbHF_theo)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	476
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	477 if ( (nb_hf >= (nbHF_theo - l1s.pw_mgr.c_delta_hf_acquis)) &&
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	478 (nb_hf <= (nbHF_theo + l1s.pw_mgr.c_delta_hf_acquis)) )
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	479 {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	480 l1s.pw_mgr.histo[idx][0] = nb_32khz;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	481 l1s.pw_mgr.histo[idx++][1] = nb_hf;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	482 idx = idx % SIZE_HIST;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	483
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	484 // compute clk ratio on count average
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	485 if(++nb_gaug >= SIZE_HIST) n=SIZE_HIST;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	486 else n= nb_gaug;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	487 SUM(sumHF,sumLF, n,i)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	488 RATIO(sumHF,sumLF,root, frac)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	489
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	490 #if (CODE_VERSION == SIMULATION)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	491 #if (TRACE_TYPE==5)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	492 trace_ULPD("Gauging ACQUIS Case ", l1s.actual_time.fn);
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	493 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	494 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	495
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	496 if ( nb_gaug == (NB_INIT+NB_ACQU)) // NB_ACQU good gauging
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	497 {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	498 gauging_state = UPDATE; // UPDATE state
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	499 l1s.pw_mgr.enough_gaug = TRUE; // allow Deep sleep
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	500 l1ctl_pgm_clk32(sumHF,sumLF); // clocks ratio in 4.33Mhz
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	501 }
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	502 }
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	503 else
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	504 {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	505 gauging_state = RESET;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	506 }
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	507 }
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	508 break;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	509
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	510 case UPDATE:
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	511 {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	512
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	513 // Update gauging histogram
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	514 // compute nbHF theoric for ratio_avg
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	515 HFTHEO(nb_32khz,root,frac,nbHF_theo)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	516
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	517 if ( (nb_hf >= (nbHF_theo-l1s.pw_mgr.c_delta_hf_update)) &&
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	518 (nb_hf <= (nbHF_theo+l1s.pw_mgr.c_delta_hf_update)) )
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	519 {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	520 l1s.pw_mgr.histo[idx][0] = nb_32khz;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	521 l1s.pw_mgr.histo[idx++][1] = nb_hf;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	522
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	523 // compute clk ratio on count average
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	524 SUM(sumHF,sumLF, SIZE_HIST,i)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	525 l1ctl_pgm_clk32(sumHF,sumLF); // clocks ratio in 4.33Mhz
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	526
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	527 l1s.pw_mgr.enough_gaug = TRUE; // allow Deep sleep
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	528 bad_count = 0; // reset count of BAD gauging
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	529
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	530 #if (CODE_VERSION == SIMULATION)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	531 #if (TRACE_TYPE==5)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	532 trace_ULPD("Gauging UPDATE Case ", l1s.actual_time.fn);
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	533 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	534 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	535
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	536 }
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	537 else
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	538 {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	539 bad_count ++;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	540 if (bad_count >= MAX_BAD_GAUGING) gauging_state = RESET;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	541 l1s.pw_mgr.enough_gaug= FALSE; // forbid Deep sleep
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	542 }
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	543 idx = idx % SIZE_HIST;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	544 }
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	545 break;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	546 }
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	547 #if (TRACE_TYPE != 0) // Trace gauging
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	548 // save parameters in the corresponding structure
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	549 l1s.pw_mgr.state = gauging_state;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	550 l1s.pw_mgr.lf = nb_32khz ;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	551 // WARNING WARNING, this case gauging_state == UPDATE modify the algo.
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	552 // In case of trace the parameter root and frac are refresh.
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	553 // it is not the case if no trace and it seems there is mistake
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	554 #if 0 /* FreeCalypso TCS211 reconstruction */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	555 if (gauging_state == UPDATE)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	556 {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	557 RATIO2(sumHF,sumLF,root,frac);
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	558 }
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	559 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	560 //End of Warning.
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	561 l1s.pw_mgr.hf = nb_hf ;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	562 l1s.pw_mgr.root = root ;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	563 l1s.pw_mgr.frac = frac ;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	564 #endif // End Trace gauging
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	565 }
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	566 }
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	567
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	568
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	569 /* GAUGING_Handler() */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	570 /* Description: update increment counter for 32Khz */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	571 /* This interrupt function computes the ratio between */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	572 /* HF/32Khz gauging counters and program ULPD increment */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	573 /* values. */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	574
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	575 void GAUGING_Handler(void)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	576 {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	577 #if (CODE_VERSION != SIMULATION)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	578 if (l1_config.pwr_mngt == PWR_MNGT)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	579 {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	580 UWORD32 nb_32khz, nb_hf;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	581
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	582 // Gauging task is ended
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	583 l1s.pw_mgr.gauging_task = INACTIVE;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	584 #if (CHIPSET == 12) \|\| (CHIPSET == 15)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	585 F_INTH_DISABLE_ONE_IT(C_INTH_ULPD_GAUGING_IT); // Mask ULPD GAUGING int.
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	586 #else
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	587 INTH_DISABLEONEIT(IQ_ULPD_GAUGING); // Mask ULPD GAUGING int.
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	588 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	589
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	590 // Number of 32 Khz clock at the end of the gauging
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	591 nb_32khz = ((( UWORD16 )ULDP_COUNTER_32_MSB_REG) * 65536) +
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	592 (( UWORD16 )ULDP_COUNTER_32_LSB_REG);
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	593
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	594 // Number of high frequency clock at the end of the gauging
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	595 // Convert it in nbr of 13 Mhz clocks (5*13=65Mhz)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	596 nb_hf = ( ((( UWORD16 )ULDP_COUNTER_HI_FREQ_MSB_REG) * 65536) +
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	597 (( UWORD16 )ULDP_COUNTER_HI_FREQ_LSB_REG) ); // Divide by PLL ratio
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	598
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	599 l1ctl_gauging(nb_32khz, nb_hf);
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	600 }
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	601 #else //Simulation part
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	602
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	603 // Gauging task is ended
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	604 l1s.pw_mgr.gauging_task = INACTIVE;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	605
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	606 l1ctl_gauging(DEFAULT_32KHZ_VALUE,DEFAULT_HFMHZ_VALUE);
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	607 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	608 }
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	609
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	610
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	611 // l1s_get_HWTimers_ticks()
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	612 // Description:
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	613 // evaluate the loading of the HW Timers for dep sleep
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	614 // BIG SLEEP: timers CLK may be stopped (user dependant)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	615 // DEEP SLEEP:timers CLK and WTCHDOG CLK are stopped
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	616 // CLKS are enabled after VTCX0+SLICER+13MHZ
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	617 // setup time
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	618
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	619 WORD32 l1s_get_HWTimers_ticks(void)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	620 {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	621 #if (CODE_VERSION != SIMULATION)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	622 WORD32 timer1,timer2,watchdog,HWTimer;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	623 #if (CHIPSET == 12) \|\| (CHIPSET == 15)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	624 WORD32 watchdog_sec;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	625 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	626 UWORD16 cntlreg;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	627 UWORD16 modereg;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	628 WORD32 old = 0;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	629
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	630 // read Hercules Timers & Watchdog
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	631 //=================================================
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	632 // Tint = Tclk * (LOAD_TIM+1) * 2^(PTV+1)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	633 // Tclk = 1.2308us for Fclk=13Mhz
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	634 // PTV = X (pre-scaler field)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	635 //-------------------------------------------------
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	636 timer1 = timer2 = watchdog = HWTimer = -1;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	637 #if (CHIPSET == 12) \|\| (CHIPSET == 15)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	638 watchdog_sec = -1;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	639 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	640
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	641 cntlreg = Dtimer1_Get_cntlreg(); // AND 0x1F
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	642 if ( (cntlreg & D_TIMER_RUN) == D_TIMER_RUN)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	643 {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	644 #if 0 /* match TCS211 object */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	645 cntlreg = cntlreg&0x1F;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	646 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	647 cntlreg >>= 2; // take PTV
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	648 cntlreg = 1 << (cntlreg+1);
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	649 timer1 = (WORD32) ( ((Dtimer1_ReadValue()+1) * cntlreg * 0.0012308) / 4.615 );
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	650 if (timer1 <= MIN_SLEEP_TIME) return(0);
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	651 old = Dtimer1_ReadValue();
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	652 HWTimer = timer1;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	653 }
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	654
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	655 cntlreg = Dtimer2_Get_cntlreg();
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	656 if ( (cntlreg & D_TIMER_RUN) == D_TIMER_RUN)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	657 {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	658 #if 0 /* match TCS211 object */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	659 cntlreg = cntlreg&0x1F;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	660 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	661 cntlreg >>= 2; // take PTV
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	662 cntlreg = 1 << (cntlreg+1);
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	663 timer2 = (WORD32) ( ((Dtimer2_ReadValue()+1) * cntlreg * 0.0012308) / 4.615 );
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	664 if (timer2 <= MIN_SLEEP_TIME) return(0);
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	665 if (HWTimer == -1) HWTimer = timer2;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	666 else MIN(HWTimer,timer2)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	667 }
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	668
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	669 cntlreg = TIMER_Read(0); // AND 0x0f80
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	670 modereg = TIMER_Read(2);
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	671
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	672 if ( (cntlreg & TIMER_ST) \|\| (modereg & TIMER_WDOG))
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	673 {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	674 // in watchdog mode PTV is forced to 7
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	675 if ( modereg & TIMER_WDOG )
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	676 cntlreg \|= TIMER_PTV;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	677
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	678 cntlreg = (cntlreg & TIMER_PTV) >> 9; // take PTV
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	679 cntlreg = 1 << (cntlreg+1);
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	680 watchdog = (WORD32) ( ((TIMER_ReadValue()+1) * cntlreg * 0.001078) / 4.615 );
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	681 if (watchdog <= MIN_SLEEP_TIME) return(0);
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	682 if (HWTimer == -1) HWTimer = watchdog;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	683 else MIN(HWTimer,watchdog)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	684 }
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	685
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	686 #if (CHIPSET == 12) \|\| (CHIPSET == 15)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	687 /*
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	688 * Secure Watchdog Timer management
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	689 */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	690 cntlreg = TIMER_SEC_Read(0); // AND 0x0f80
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	691 modereg = TIMER_SEC_Read(2);
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	692 if ( (cntlreg & TIMER_ST) \|\| (modereg & TIMER_WDOG))
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	693 {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	694 // in watchdog mode PTV is forced to 7
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	695 if ( modereg & TIMER_WDOG )
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	696 cntlreg \|= TIMER_PTV;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	697
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	698 cntlreg = (cntlreg & TIMER_PTV) >> 9; // take PTV
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	699 cntlreg = 1 << (cntlreg+1);
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	700 watchdog_sec = (WORD32) ( ((TIMER_SEC_ReadValue()+1) * cntlreg * 0.001078) / 4.615 );
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	701 if (watchdog_sec <= MIN_SLEEP_TIME) return(0);
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	702 if (HWTimer == -1) HWTimer = watchdog_sec;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	703 else MIN(HWTimer,watchdog_sec)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	704 }
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	705
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	706 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	707
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	708 return (HWTimer);
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	709 #else // simulation part
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	710 return (-1); // no HW timer in simulation
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	711 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	712 }
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	713
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	714 #if (GSM_IDLE_RAM != 0) // Compile only if GSM_IDLE_RAM enabled
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	715
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	716 void l1s_adapt_traffic_controller(void)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	717 {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	718 BOOL l1s_extram;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	719 UWORD8 nb_bitmap;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	720 T_L1S_GSM_IDLE_INTRAM * gsm_idle_ram_ctl;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	721
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	722 gsm_idle_ram_ctl = &(l1s.gsm_idle_ram_ctl);
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	723
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	724 l1s_extram = FALSE;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	725
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	726 for(nb_bitmap=0; ((nb_bitmap < SIZE_TAB_L1S_MONITOR) && (l1s_extram == FALSE)); nb_bitmap++)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	727 {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	728 if (nb_bitmap == 1)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	729 {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	730 l1s_extram \|= (((INT_RAM_GSM_IDLE_L1S_PROCESSES1 ^ gsm_idle_ram_ctl->task_bitmap_idle_ram[nb_bitmap]) & gsm_idle_ram_ctl->task_bitmap_idle_ram[nb_bitmap]) != 0);
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	731 }else
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	732 {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	733 l1s_extram \|= (gsm_idle_ram_ctl->task_bitmap_idle_ram[nb_bitmap] != 0);
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	734 }
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	735 }
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	736
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	737 if ((l1s_extram != FALSE) && (!READ_TRAFFIC_CONT_STATE))
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	738 {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	739 CSMI_TrafficControllerOn();
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	740 #if (TRACE_TYPE==1) \|\| (TRACE_TYPE==4)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	741 {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	742 l1s_trace_mftab();
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	743 }
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	744 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	745 }
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	746 }
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	747 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	748
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	749 UWORD32 last_wakeup = 0;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	750 UWORD8 wakeup_type; // Type of the interrupt
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	751 UWORD8 why_big_sleep; // Type of the big sleep
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	752
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	753 extern UWORD16 int_id;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	754
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	755 // l1s_sleep_manager()
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	756 // Description:
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	757 // evaluate the loading of the system
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	758 // - SIM, UART, LCD ....
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	759 // - Nucleus tasks, Hisrs, timers
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	760 // - Timer1, Timer2, Watchdog
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	761 // program Big or Deep sleep
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	762
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	763 void l1s_sleep_manager()
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	764 {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	765 //UWORD8 temp=0; OMAPS00090550
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	766
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	767 UWORD16 temp_clear_intr;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	768
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	769 // fn when l1s_sleep_manager function is called
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	770 #if (CODE_VERSION != SIMULATION)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	771 UWORD32 sleep_time = l1s.actual_time.fn_mod42432;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	772 #else
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	773 UWORD32 sleep_time = l1s.actual_time.fn;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	774 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	775
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	776 if (l1_config.pwr_mngt == PWR_MNGT)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	777 {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	778 // Power management is enabled
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	779 WORD32 min_time, HWtimer,wake_up_time,min_time_gauging;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	780 WORD32 afc_fix;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	781 static UWORD32 previous_sleep = CLOCK_STOP;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	782 #if (W_A_CALYPSO_PLUS_SPR_19599 == 1)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	783 BOOL extended_page_mode_state = 0; //Store state of extended page mode
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	784 #endif
561 dc1e0a1c100f sleep logic change: allow big sleep when UART or SIM is blocking deep sleep Mychaela Falconia <falcon@freecalypso.org> parents: 328 diff changeset	785 WORD32 time_from_last_wakeup, min_time_from_last_wakeup;
69 50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	786 UWORD32 sleep_mode;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	787
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	788 #if (OP_BT == 1)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	789 WORD32 hci_ll_status;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	790 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	791
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	792 // init for trace and debug
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	793 why_big_sleep = BIG_SLEEP_DUE_TO_UNDEFINED;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	794 wakeup_type = WAKEUP_FOR_UNDEFINED;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	795
561 dc1e0a1c100f sleep logic change: allow big sleep when UART or SIM is blocking deep sleep Mychaela Falconia <falcon@freecalypso.org> parents: 328 diff changeset	796 /*
dc1e0a1c100f sleep logic change: allow big sleep when UART or SIM is blocking deep sleep Mychaela Falconia <falcon@freecalypso.org> parents: 328 diff changeset	797 * FreeCalypso change: TI's original code implemented logic to
dc1e0a1c100f sleep logic change: allow big sleep when UART or SIM is blocking deep sleep Mychaela Falconia <falcon@freecalypso.org> parents: 328 diff changeset	798 * suppress both big and deep sleep (i.e., retry on the next frame)
dc1e0a1c100f sleep logic change: allow big sleep when UART or SIM is blocking deep sleep Mychaela Falconia <falcon@freecalypso.org> parents: 328 diff changeset	799 * if less than 7 frames have elapsed since the last wakeup and
dc1e0a1c100f sleep logic change: allow big sleep when UART or SIM is blocking deep sleep Mychaela Falconia <falcon@freecalypso.org> parents: 328 diff changeset	800 * if the previous sleep cycle was CLOCK_STOP. We are changing
dc1e0a1c100f sleep logic change: allow big sleep when UART or SIM is blocking deep sleep Mychaela Falconia <falcon@freecalypso.org> parents: 328 diff changeset	801 * this logic in two ways: the check has been moved up here
dc1e0a1c100f sleep logic change: allow big sleep when UART or SIM is blocking deep sleep Mychaela Falconia <falcon@freecalypso.org> parents: 328 diff changeset	802 * (originally the check code was way down, wasting work on other
dc1e0a1c100f sleep logic change: allow big sleep when UART or SIM is blocking deep sleep Mychaela Falconia <falcon@freecalypso.org> parents: 328 diff changeset	803 * logic if there will be no sleep anyway), and we additionally
dc1e0a1c100f sleep logic change: allow big sleep when UART or SIM is blocking deep sleep Mychaela Falconia <falcon@freecalypso.org> parents: 328 diff changeset	804 * suppress both big and deep sleep (effecting retry on the next
dc1e0a1c100f sleep logic change: allow big sleep when UART or SIM is blocking deep sleep Mychaela Falconia <falcon@freecalypso.org> parents: 328 diff changeset	805 * frame) if the previous sleep cycle was FRAME_STOP and less than
dc1e0a1c100f sleep logic change: allow big sleep when UART or SIM is blocking deep sleep Mychaela Falconia <falcon@freecalypso.org> parents: 328 diff changeset	806 * 5 frames have elapsed since wakeup. The reason for the latter
dc1e0a1c100f sleep logic change: allow big sleep when UART or SIM is blocking deep sleep Mychaela Falconia <falcon@freecalypso.org> parents: 328 diff changeset	807 * addition is that we now allow big sleep while UART and/or SIM
dc1e0a1c100f sleep logic change: allow big sleep when UART or SIM is blocking deep sleep Mychaela Falconia <falcon@freecalypso.org> parents: 328 diff changeset	808 * activity timers are running (suppressing deep sleep), and
dc1e0a1c100f sleep logic change: allow big sleep when UART or SIM is blocking deep sleep Mychaela Falconia <falcon@freecalypso.org> parents: 328 diff changeset	809 * holding off for 5 frames before going into another big sleep
dc1e0a1c100f sleep logic change: allow big sleep when UART or SIM is blocking deep sleep Mychaela Falconia <falcon@freecalypso.org> parents: 328 diff changeset	810 * keeps us from fluttering in and out of big sleep as the external
dc1e0a1c100f sleep logic change: allow big sleep when UART or SIM is blocking deep sleep Mychaela Falconia <falcon@freecalypso.org> parents: 328 diff changeset	811 * host or the SIM is trying to talk to us.
dc1e0a1c100f sleep logic change: allow big sleep when UART or SIM is blocking deep sleep Mychaela Falconia <falcon@freecalypso.org> parents: 328 diff changeset	812 */
69 50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	813 time_from_last_wakeup = (sleep_time - last_wakeup + 42432) % 42432;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	814
561 dc1e0a1c100f sleep logic change: allow big sleep when UART or SIM is blocking deep sleep Mychaela Falconia <falcon@freecalypso.org> parents: 328 diff changeset	815 if (previous_sleep == CLOCK_STOP)
dc1e0a1c100f sleep logic change: allow big sleep when UART or SIM is blocking deep sleep Mychaela Falconia <falcon@freecalypso.org> parents: 328 diff changeset	816 min_time_from_last_wakeup = 7;
dc1e0a1c100f sleep logic change: allow big sleep when UART or SIM is blocking deep sleep Mychaela Falconia <falcon@freecalypso.org> parents: 328 diff changeset	817 else
dc1e0a1c100f sleep logic change: allow big sleep when UART or SIM is blocking deep sleep Mychaela Falconia <falcon@freecalypso.org> parents: 328 diff changeset	818 min_time_from_last_wakeup = 5;
dc1e0a1c100f sleep logic change: allow big sleep when UART or SIM is blocking deep sleep Mychaela Falconia <falcon@freecalypso.org> parents: 328 diff changeset	819
dc1e0a1c100f sleep logic change: allow big sleep when UART or SIM is blocking deep sleep Mychaela Falconia <falcon@freecalypso.org> parents: 328 diff changeset	820 if (time_from_last_wakeup < min_time_from_last_wakeup)
dc1e0a1c100f sleep logic change: allow big sleep when UART or SIM is blocking deep sleep Mychaela Falconia <falcon@freecalypso.org> parents: 328 diff changeset	821 return;
dc1e0a1c100f sleep logic change: allow big sleep when UART or SIM is blocking deep sleep Mychaela Falconia <falcon@freecalypso.org> parents: 328 diff changeset	822
69 50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	823 //=================================================
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	824 // check System (SIM, UART, LDC ..... )
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	825 //=================================================
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	826 sleep_mode = Cust_check_system();
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	827
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	828 if (sleep_mode == DO_NOT_SLEEP)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	829 return;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	830
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	831 #if (CODE_VERSION != SIMULATION)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	832 //=================================================
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	833 // Protect System structures
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	834 // must be called BEFORE INT_DisableIRQ() while
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	835 // Nucleus does not restore IRQ/FIQ bits !!!!
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	836 //=================================================
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	837 OS_system_protect();
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	838 //=================================================
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	839 // Disable IRQ
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	840 //=================================================
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	841 INT_DisableIRQ();
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	842 #endif // NOT SIMULATION
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	843
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	844 //=================================================
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	845 // check OS loading
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	846 //=================================================
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	847 min_time = OS_get_inactivity_ticks();
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	848
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	849 //=================================================
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	850 // check HW Timers loading
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	851 //=================================================
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	852 HWtimer= l1s_get_HWTimers_ticks();
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	853
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	854 //=================================================
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	855 // check next gauging task for Packet Idle
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	856 //=================================================
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	857 #if L1_GPRS
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	858 min_time_gauging = l1s_get_next_gauging_in_Packet_Idle();
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	859 #else
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	860 min_time_gauging = -1; // not used
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	861 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	862
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	863 #if (OP_BT == 1)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	864 hci_ll_status = hci_ll_ok_for_sleep();
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	865 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	866 // check if immediate activity planned
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	867 // 0 means immediate activity
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	868 // in case big sleep is choosen (sleep mode == FRAME_STOP) because of UART or SIM,
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	869 // return and wait end of this activity (few TDMA frames) then check on next TDMA frames
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	870 // if MS can go in deep sleep
328 daddb933047d L1 sleep logic change: allow big sleep when light is on or we are charging Mychaela Falconia <falcon@freecalypso.org> parents: 69 diff changeset	871 /*
561 dc1e0a1c100f sleep logic change: allow big sleep when UART or SIM is blocking deep sleep Mychaela Falconia <falcon@freecalypso.org> parents: 328 diff changeset	872 * FreeCalypso change: we no longer abstain from big sleep because of UART
dc1e0a1c100f sleep logic change: allow big sleep when UART or SIM is blocking deep sleep Mychaela Falconia <falcon@freecalypso.org> parents: 328 diff changeset	873 * and SIM activity timers, i.e., when deep sleep is suppressed because of
dc1e0a1c100f sleep logic change: allow big sleep when UART or SIM is blocking deep sleep Mychaela Falconia <falcon@freecalypso.org> parents: 328 diff changeset	874 * either of those, we go into big sleep instead. We also do big sleep
dc1e0a1c100f sleep logic change: allow big sleep when UART or SIM is blocking deep sleep Mychaela Falconia <falcon@freecalypso.org> parents: 328 diff changeset	875 * if deep sleep is disallowed because of the backlight or charging.
dc1e0a1c100f sleep logic change: allow big sleep when UART or SIM is blocking deep sleep Mychaela Falconia <falcon@freecalypso.org> parents: 328 diff changeset	876 * However, if the UART issue is not the running activity timer, but some
dc1e0a1c100f sleep logic change: allow big sleep when UART or SIM is blocking deep sleep Mychaela Falconia <falcon@freecalypso.org> parents: 328 diff changeset	877 * output being drained from the Tx FIFO, for that case our new code in
dc1e0a1c100f sleep logic change: allow big sleep when UART or SIM is blocking deep sleep Mychaela Falconia <falcon@freecalypso.org> parents: 328 diff changeset	878 * Cust_check_system() will return DO_NOT_SLEEP (checked above), causing
dc1e0a1c100f sleep logic change: allow big sleep when UART or SIM is blocking deep sleep Mychaela Falconia <falcon@freecalypso.org> parents: 328 diff changeset	879 * us to retry on the next frame and hopefully go into deep sleep after
dc1e0a1c100f sleep logic change: allow big sleep when UART or SIM is blocking deep sleep Mychaela Falconia <falcon@freecalypso.org> parents: 328 diff changeset	880 * another frame or two.
328 daddb933047d L1 sleep logic change: allow big sleep when light is on or we are charging Mychaela Falconia <falcon@freecalypso.org> parents: 69 diff changeset	881 */
69 50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	882 if ( !min_time
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	883 \|\| !HWtimer
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	884 \|\| !min_time_gauging
328 daddb933047d L1 sleep logic change: allow big sleep when light is on or we are charging Mychaela Falconia <falcon@freecalypso.org> parents: 69 diff changeset	885 #if 0 /* FreeCalypso change */
69 50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	886 \|\| (sleep_mode != CLOCK_STOP)
328 daddb933047d L1 sleep logic change: allow big sleep when light is on or we are charging Mychaela Falconia <falcon@freecalypso.org> parents: 69 diff changeset	887 #endif
69 50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	888 #if (OP_BT == 1)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	889 \|\| !hci_ll_status
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	890 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	891 )
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	892 {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	893
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	894
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	895 #if (CODE_VERSION != SIMULATION)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	896 OS_system_Unprotect();
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	897 // free System structure
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	898 // Enable all IRQ
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	899 INT_EnableIRQ();
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	900 // Wake up UART
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	901
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	902 SER_WakeUpUarts(); // Wake up Uarts
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	903
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	904 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	905 return;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	906 }
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	907 //=================================================
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	908 // Select sleep duration ....
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	909 //=================================================
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	910 // remember: -1 means no activity planned
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	911 //l1a_l1s_com.time_to_next_l1s_task is UW32, min_time is W32. Max value of l1a_l1s_com.time_to_next_l1s_task will be 2p31
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	912 //and ,min_time max value will be 2p30. If min_time > l1a_l1s_com.time_to_next_l1s_task,
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	913 //means MSB of l1a_l1s_com.time_to_next_l1s_task is zero. so, we can use- uw32_store_next_time & 0x7FFFFFFF
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	914
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	915 if (min_time == -1) min_time = l1a_l1s_com.time_to_next_l1s_task;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	916 else MIN(min_time, l1a_l1s_com.time_to_next_l1s_task)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	917 if (HWtimer != -1) MIN(min_time, HWtimer)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	918 if (min_time_gauging != -1) MIN(min_time, min_time_gauging)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	919
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	920 #if (TRACE_TYPE !=0 ) && (TRACE_TYPE != 2) && (TRACE_TYPE != 3)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	921 // to trace the Wake up source
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	922 // depending of min_time choose the wakeup_type
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	923 wakeup_type = WAKEUP_FOR_OS_TASK;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	924 if (min_time == l1a_l1s_com.time_to_next_l1s_task) wakeup_type = WAKEUP_FOR_L1_TASK;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	925 if (min_time == HWtimer) wakeup_type = WAKEUP_FOR_HW_TIMER_TASK;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	926 if (min_time == min_time_gauging) wakeup_type = WAKEUP_FOR_GAUGING_TASK;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	927 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	928
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	929 //=================================================
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	930 // Choose DEEP or BIG SLEEP
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	931 //=================================================
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	932 if ( ((l1s.pw_mgr.mode_authorized == DEEP_SLEEP) && (sleep_mode == CLOCK_STOP)) \|\|
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	933 ((l1s.pw_mgr.mode_authorized == ALL_SLEEP) && (sleep_mode == CLOCK_STOP)) )
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	934 {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	935 // Check now gauging histogramme or if in inactive period of cell selection
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	936 #if (W_A_DSP_IDLE3 == 1) && (CODE_VERSION!=SIMULATION)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	937 if (((l1s.pw_mgr.enough_gaug == TRUE) \|\| (l1a_l1s_com.mode == CS_MODE0)) &&
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	938 ( l1s_dsp_com.dsp_ndb_ptr->d_dsp_state == C_DSP_IDLE3))
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	939 #else
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	940 #if (CHIPSET == 12) \|\| (CHIPSET == 15)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	941 if (((l1s.pw_mgr.enough_gaug == TRUE) \|\| (l1a_l1s_com.mode == CS_MODE0)) &&
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	942 !CLKM_READ_nIDLE3)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	943 #else
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	944 if ((l1s.pw_mgr.enough_gaug == TRUE) \|\| (l1a_l1s_com.mode == CS_MODE0))
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	945 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	946 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	947 l1s.pw_mgr.sleep_performed = CLOCK_STOP;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	948 else
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	949 {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	950 // BIG SLEEP is chosen : check the reason
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	951 l1s.pw_mgr.sleep_performed = FRAME_STOP;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	952 if (l1s.pw_mgr.enough_gaug != TRUE)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	953 why_big_sleep = BIG_SLEEP_DUE_TO_GAUGING;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	954 else
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	955 why_big_sleep = BIG_SLEEP_DUE_TO_DSP_TRACES;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	956 }
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	957 }
571 b24d42baa30d BIG_SMALL_SLEEP mode implemented Mychaela Falconia <falcon@freecalypso.org> parents: 561 diff changeset	958 if (l1s.pw_mgr.mode_authorized == BIG_SLEEP \|\|
b24d42baa30d BIG_SMALL_SLEEP mode implemented Mychaela Falconia <falcon@freecalypso.org> parents: 561 diff changeset	959 l1s.pw_mgr.mode_authorized == BIG_SMALL_SLEEP)
69 50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	960 why_big_sleep = BIG_SLEEP_DUE_TO_SLEEP_MODE;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	961
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	962 if ( ((l1s.pw_mgr.mode_authorized == BIG_SLEEP) && (sleep_mode >= FRAME_STOP)) \|\|
571 b24d42baa30d BIG_SMALL_SLEEP mode implemented Mychaela Falconia <falcon@freecalypso.org> parents: 561 diff changeset	963 ((l1s.pw_mgr.mode_authorized == BIG_SMALL_SLEEP) && (sleep_mode >= FRAME_STOP)) \|\|
69 50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	964 ((l1s.pw_mgr.mode_authorized >= DEEP_SLEEP) && (sleep_mode == FRAME_STOP)) )
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	965 l1s.pw_mgr.sleep_performed = FRAME_STOP;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	966
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	967
561 dc1e0a1c100f sleep logic change: allow big sleep when UART or SIM is blocking deep sleep Mychaela Falconia <falcon@freecalypso.org> parents: 328 diff changeset	968 /* FreeCalypso change: check moved up and extended */
dc1e0a1c100f sleep logic change: allow big sleep when UART or SIM is blocking deep sleep Mychaela Falconia <falcon@freecalypso.org> parents: 328 diff changeset	969 #if 0
69 50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	970 if ((previous_sleep == CLOCK_STOP) && (time_from_last_wakeup < 7))
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	971 {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	972 #if (CODE_VERSION != SIMULATION)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	973 OS_system_Unprotect(); // free System structure
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	974 INT_EnableIRQ(); // Enable all IRQ
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	975
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	976 SER_WakeUpUarts(); // Wake up Uarts
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	977
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	978 #endif // NOT SIMULATION
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	979 return;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	980 }
561 dc1e0a1c100f sleep logic change: allow big sleep when UART or SIM is blocking deep sleep Mychaela Falconia <falcon@freecalypso.org> parents: 328 diff changeset	981 #endif
69 50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	982
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	983 // update previous sleep
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	984 previous_sleep = l1s.pw_mgr.sleep_performed;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	985
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	986
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	987 #if (CODE_VERSION != SIMULATION)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	988
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	989 #if (CHIPSET == 12) \|\| (CHIPSET == 15)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	990 F_INTH_DISABLE_ONE_IT(C_INTH_FRAME_IT); // mask Frame int.
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	991 #else
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	992 INTH_DISABLEONEIT(IQ_FRAME); // mask Frame int.
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	993 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	994 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	995
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	996 //=====================================================
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	997 // if CLOCK_STOP : stop RF, TPU, asleep Omega, DPLL, SPI
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	998 // if FRAME_STOP : asleep Omega, SPI
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	999 //=====================================================
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1000 #if (CODE_VERSION != SIMULATION)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1001 if ( l1s.pw_mgr.sleep_performed == CLOCK_STOP )
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1002 {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1003 // ==== STop RF and TPU..... ===================
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1004
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1005 //L1_trace_string("Proceeding to Deep Sleep\n");
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1006
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1007
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1008 l1dmacro_RF_sleep();
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1009
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1010 // ((volatile UWORD16 )l1s_tpu_com.reg_cmd) =TPU_CTRL_RESET \|
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1011 // TSP_CTRL_RESET \|TPU_CTRL_CLK_EN;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1012 // ((volatile UWORD16 )l1s_tpu_com.reg_cmd) =0;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1013
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1014 //===== SET default value for gauging =========
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1015 // If we have come in here during the inactive period of cell
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1016 // selection, then load the ULPD timers with default values
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1017 // (used when the MS lost the network: in this case the deep sleep may be used)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1018 if (l1a_l1s_com.mode == CS_MODE0)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1019 {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1020 l1ctl_pgm_clk32(DEFAULT_HFMHZ_VALUE, DEFAULT_32KHZ_VALUE);
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1021 }
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1022 }
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1023
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1024
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1025 //==============================================
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1026 // disable DPLL (do not provide clk to DSP & RIF (RIF))
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1027 //==============================================
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1028 #if ((CHIPSET ==4) \|\| (CHIPSET == 7) \|\| (CHIPSET == 8) \|\| (CHIPSET == 10) \|\| (CHIPSET == 11) \|\| (CHIPSET == 12) \|\| (CHIPSET == 15))
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1029 // disable DPLL (do not provide clk to DSP & RIF (Bridge))
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1030 ( * (volatile SYS_UWORD16 *) CLKM_CNTL_CLK) \|= CLKM_DPLL_DIS \| CLKM_BRIDGE_DIS;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1031 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1032
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1033 //==============================================
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1034 // if CLOCK_STOP or FRAME-STOP : Asleep OMEGA (ABB)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1035 //==============================================
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1036 afc_fix = ABB_sleep(l1s.pw_mgr.sleep_performed, l1s.afc);
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1037
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1038 #if (OP_BT == 1)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1039 hci_ll_go_to_sleep();
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1040 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1041 //=================================================
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1042 // STop SPI .....
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1043 //=================================================
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1044
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1045 ((volatile UWORD16 )MEM_SPI)&=0xFFFE; // SPI CLK DISABLED
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1046 #endif // NOT SIMULATION
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1047
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1048
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1049 //=================================================
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1050 // CQ19599: For Calypso+ chipset, extended page mode
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1051 // shall be disabled before entering deep sleep and
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1052 // restored at wake up
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1053 //=================================================
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1054 #if (W_A_CALYPSO_PLUS_SPR_19599 == 1)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1055 extended_page_mode_state = (BOOL) f_memif_extended_page_mode_read_bit();
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1056 f_memif_extended_page_mode_disable();
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1057 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1058
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1059 //=================================================
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1060 // Init the timer :
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1061 //
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1062 // a margin of 4 frames (>MIN_SLEEP_TIME) is taken
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1063 // when evaluating system loading, because 1 frame
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1064 // is lost for wakeup only, and because sleep
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1065 // duration less than 1 frame is not worth ....
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1066 //
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1067 // 1 2 3 4 5 6 7 8
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1068 // SLEEP_CTRL SLEEP WAKEUP TASK (RF,Timer, ...)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1069 //
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1070 //=================================================
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1071 //ULPD Timer can be loaded up to MAX_GSM_TIMER (possible in CS_MODE0)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1072 if ( l1s.pw_mgr.sleep_performed == CLOCK_STOP )
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1073 {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1074 // DEEP SLEEP -> need time to setup afc and rf
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1075 wake_up_time = min_time - l1_config.params.setup_afc_and_rf;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1076 }
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1077 else
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1078 // BIG SLEEP
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1079 wake_up_time = min_time - 1;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1080
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1081
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1082
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1083 #if (CODE_VERSION != SIMULATION)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1084 if ( wake_up_time >= MAX_GSM_TIMER)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1085 ULDP_TIMER_INIT(MAX_GSM_TIMER);
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1086 else
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1087 ULDP_TIMER_INIT(wake_up_time);
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1088
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1089 ULDP_TIMER_LD; // Load the timer
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1090
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1091 // BUG3060. Clear pending IQ_TGSM from ULPD. This could happen in case ULPD was frozen
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1092 // with zero into its GSM counter. In that case, the interrupt is still pending
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1093 // and if it is not cleared, it wakes the board up just after switching the clock.
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1094 // Clear it into the ULPD...
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1095 // The ULDP_GSM_TIMER_IT_REG is a read only register and is cleared on
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1096 //reading the register.
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1097 temp_clear_intr =(* (volatile UWORD16 *) ULDP_GSM_TIMER_IT_REG) & ULPD_IT_TIMER_GSM;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1098 // ... and next into the INTH. (must be done in this order
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1099
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1100 #if (CHIPSET == 12) \|\| (CHIPSET == 15)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1101 F_INTH_RESET_ONE_IT(C_INTH_TGSM_IT);
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1102 F_INTH_ENABLE_ONE_IT(C_INTH_TGSM_IT);
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1103 #else
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1104 INTH_RESETONEIT(IQ_TGSM); // clear TDMA IRQ
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1105 INTH_ENABLEONEIT(IQ_TGSM); // Unmask ULPD GSM int.
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1106 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1107
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1108 #if (GSM_IDLE_RAM != 0)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1109 if (READ_TRAFFIC_CONT_STATE)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1110 {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1111 CSMI_TrafficControllerOff();
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1112 }
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1113 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1114
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1115 ULDP_TIMER_START; // start count down
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1116
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1117
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1118 #if (GSM_IDLE_RAM_DEBUG == 1)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1119 (( volatile unsigned short )(0xFFFE4802)) &= ~ (1 << 2); // GPIO-2=0
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1120 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1121
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1122 if ( l1s.pw_mgr.sleep_performed == CLOCK_STOP )
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1123 // DEEP SLEEP
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1124 {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1125 #if (OP_WCP == 1) && (OP_L1_STANDALONE != 1)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1126 // specific sleep for WCP
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1127 arm7_deep_sleep();
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1128 #else // NO OP_WCP
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1129 #if (W_A_CALYPSO_BUG_01435 == 1)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1130 f_arm_sleep_cmd(DEEP_SLEEP);
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1131 #else
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1132 ((volatile UWORD16 )CLKM_ARM_CLK) &= ~(CLKM_DEEP_SLEEP); // set deep sleep mode
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1133 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1134 #endif // OP_WCP
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1135 }
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1136 else
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1137 {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1138 // BIG SLEEP / l1s.pw_mgr.sleep_performed == FRAME_STOP
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1139
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1140 //==========================================================
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1141 //Shut down PERIPHERALS clocks UWIRE and ARMIO if authorized
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1142 //==========================================================
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1143
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1144 UWORD16 clocks_stopped; //OMAPS90550- new
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1145 clocks_stopped = (l1s.pw_mgr.clocks & l1s.pw_mgr.modules_status);
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1146 if((clocks_stopped & ARMIO_CLK_CUT) == ARMIO_CLK_CUT)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1147 ((volatile UWORD16 )ARMIO_CNTL_REG) &= ~(ARMIO_CLOCKEN);
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1148 if((clocks_stopped & UWIRE_CLK_CUT) == UWIRE_CLK_CUT)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1149 ((volatile UWORD16 )(MEM_UWIRE + 0x8)) &= ~(0x0001);
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1150
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1151 #if (W_A_CALYPSO_BUG_01435 == 1)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1152 f_arm_sleep_cmd(BIG_SLEEP);
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1153 #else
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1154
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1155 ((volatile UWORD16 )CLKM_ARM_CLK) &= ~(CLKM_MCLK_EN); // set big sleep mode
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1156 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1157 }
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1158 #else // Simulation part
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1159 l1s.pw_mgr.sleep_duration = wake_up_time;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1160 hw.deep_sleep_en = 1;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1161 status = NU_Suspend_Task(&L1S_task);
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1162 // check status value...
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1163 if (status)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1164 {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1165 #if (TRACE_TYPE==5)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1166 sprintf(errormsg,"Error somewhere in the L1S application to suspend : deep sleep\n");
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1167 log_sim_error(ERR);
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1168 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1169 EXIT;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1170 }
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1171 #endif // SIMULATION
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1172
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1173 //=================================================
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1174 // Wake-up procedure
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1175 //=================================================
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1176 // Restore L1 data base, Nucleus, HW Timers ....
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1177 //=================================================
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1178
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1179 #if (GSM_IDLE_RAM_DEBUG == 1)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1180 (( volatile unsigned short )(0xFFFE4802)) \|= (1 << 2); // GPIO-2=1
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1181 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1182
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1183
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1184 l1s_wakeup();
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1185
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1186 last_wakeup = l1s.actual_time.fn_mod42432;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1187
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1188 if (last_wakeup == sleep_time)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1189 // sleep duration == 0 -> wakeup in the same frame as sleep
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1190 wakeup_type = WAKEUP_ASYNCHRONOUS_SLEEP_DURATION_0;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1191
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1192 #if (GSM_IDLE_RAM != 0)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1193 // Update counters with sleep duration -> will be used case expiration in next wake up phase before traffic controller is enabled by msg sending
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1194 gsm_idle_ram_ctl->os_load -= (l1s.pw_mgr.sleep_duration);
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1195 gsm_idle_ram_ctl->hw_timer -= (l1s.pw_mgr.sleep_duration);
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1196
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1197 if (l1s.pw_mgr.wakeup_type != WAKEUP_FOR_L1_TASK)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1198 {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1199 if (!READ_TRAFFIC_CONT_STATE)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1200 {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1201 CSMI_TrafficControllerOn();
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1202 }
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1203 }
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1204 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1205 //=================================================
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1206 //if CLOCK_STOP : restart TPU and RF....
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1207 //=================================================
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1208 #if (CODE_VERSION != SIMULATION)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1209 if ( l1s.pw_mgr.sleep_performed == CLOCK_STOP )
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1210 {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1211 // ((volatile UWORD16 )l1s_tpu_com.reg_cmd) = TPU_CTRL_CLK_EN;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1212 UWORD8 local_sleep_status;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1213
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1214 l1dmacro_RF_wakeup();
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1215
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1216 }
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1217
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1218 #if ((CHIPSET ==4) \|\| (CHIPSET == 7) \|\| (CHIPSET == 8) \|\| (CHIPSET == 10) \|\| (CHIPSET == 11))
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1219 // enable DPLL (provide clk to DSP & RIF(Bridge) in small/big sleep)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1220 // On CALYPSO, BRIDGE clock can be cut according to the ARM sleep mode even during DMA transfer
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1221 ( * (volatile SYS_UWORD16 *) CLKM_CNTL_CLK) &= ~(CLKM_DPLL_DIS \| CLKM_BRIDGE_DIS);
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1222 #elif (CHIPSET == 12)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1223 // Nothing to be done because if DSP wants clock, it will exit from IDLE3 mode, which wakes up the DPLL
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1224 #elif (CHIPSET == 15)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1225 ( * (volatile SYS_UWORD16 *) CLKM_CNTL_CLK) &= ~(CLKM_DPLL_DIS);
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1226 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1227
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1228 //=================================================
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1229 //if CLOCK_STOP or FRAME-STOP : ReStart SPI
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1230 //=================================================
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1231 ((volatile UWORD16 )MEM_SPI)\|=0x0001; // SPI CLK ENABLED
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1232
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1233 //=================================================
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1234 // Wake up ABB
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1235 //=================================================
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1236 ABB_wakeup(l1s.pw_mgr.sleep_performed, l1s.afc);
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1237
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1238 #if (OP_BT == 1)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1239 hci_ll_wake_up();
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1240 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1241 #endif //CODE VERSION
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1242
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1243 //=================================================
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1244 // CQ19599: For Calypso+ chipset, restore the extended
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1245 // page mode if it was enabled before entering in sleep
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1246 //=================================================
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1247 #if (W_A_CALYPSO_PLUS_SPR_19599 == 1)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1248 if ( extended_page_mode_state != 0 )
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1249 f_memif_extended_page_mode_enable();
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1250 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1251
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1252 #if (OP_L1_STANDALONE == 0)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1253 /GC_Wakeup(); OMAPS00134004/
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1254 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1255
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1256 #if (CODE_VERSION != SIMULATION)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1257 //=================================================
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1258 // enable IRQ
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1259 //=================================================
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1260 OS_system_Unprotect();
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1261 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1262
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1263 #if (TRACE_TYPE != 0)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1264 if (l1a_l1s_com.mode != CS_MODE0) // in this mode the trace prevent from going to deep sleep due to UART activity
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1265 {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1266 #if (GSM_IDLE_RAM == 0)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1267 l1_trace_sleep(sleep_time, l1s.actual_time.fn_mod42432, l1s.pw_mgr.sleep_performed, wakeup_type, why_big_sleep);
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1268 #else
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1269 l1_trace_sleep_intram(sleep_time, l1s.actual_time.fn_mod42432, l1s.pw_mgr.sleep_performed, wakeup_type, why_big_sleep);
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1270 #if (TRACE_TYPE==1) \|\| (TRACE_TYPE==4)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1271 l1s_trace_mftab();
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1272 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1273 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1274 }
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1275 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1276
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1277 #if (TRACE_TYPE == 1) \|\| (TRACE_TYPE == 4)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1278 trace_info.sleep_performed = TRUE;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1279 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1280
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1281 #if (CODE_VERSION != SIMULATION)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1282
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1283 //=================================================
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1284 // enable IRQ
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1285 //=================================================
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1286 INT_EnableIRQ();
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1287
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1288 //=================================================
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1289 // Be careful:in case of asynchronous wake-up after sleep
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1290 // an IT_TDMA may be unmasked and executed just after OS_system_Unprotect().
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1291 // As we already are inside an hisr(), it implies the execution of an another hisr().
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1292 // In order to avoid issues with the execution of an hisr() inside the hisr()
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1293 // do not add code here after !!!
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1294 // if possible respect this rule !
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1295 //=================================================
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1296
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1297 //=================================================
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1298 // wake-up UARTs
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1299 //this function must be call after the UART interrupt,
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1300 //it means after the function INT_EnableIRQ()
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1301 //=================================================
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1302 {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1303 #if (GSM_IDLE_RAM != 0)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1304 // Traffic controller has to be enabled before calling SER_WakeUpUarts
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1305 // as this function can access the external RAM.
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1306 // Reset the flag that will indicates if an interrup will put the traffic
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1307 // controller ON during that time.
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1308 l1s.gsm_idle_ram_ctl.trff_ctrl_enable_cause_int = FALSE;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1309 if (!READ_TRAFFIC_CONT_STATE)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1310 {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1311 flag_traffic_controller_state = 1;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1312 CSMI_TrafficControllerOn();
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1313 }
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1314 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1315
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1316
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1317 SER_WakeUpUarts(); // Wake up Uarts
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1318
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1319
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1320 #if (GSM_IDLE_RAM != 0)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1321 // The traffic controller state shall be restored as it was before
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1322 // calling SER_WakeUpUarts. Do not disable it if an interrup occured
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1323 // in between and activated the traffic controller.
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1324 if ((flag_traffic_controller_state == 1) && (l1s.gsm_idle_ram_ctl.trff_ctrl_enable_cause_int == FALSE))
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1325 {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1326 CSMI_TrafficControllerOff();
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1327 }
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1328 flag_traffic_controller_state = 0;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1329 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1330 }
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1331 #endif // NOT SIMULATION
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1332 }
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1333 }
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1334
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1335 // l1s_wakeup() */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1336 // Description: wake-up of the MCU from GSM Timer it OR unscheduled wake-up
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1337 // This function read the TPU timer and fix the :
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1338 // - system clock
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1339 // - Nucleus timers
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1340 // - L1 frame counter
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1341 // - L1 next task counter
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1342 // - Hardware timers
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1343
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1344 void l1s_wakeup(void)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1345 {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1346 #if (CODE_VERSION != SIMULATION)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1347 if (l1_config.pwr_mngt == PWR_MNGT)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1348 {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1349 // Restore interrupts ....
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1350
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1351 #if (CHIPSET == 12) \|\| (CHIPSET == 15)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1352 // mask TGSM int.
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1353 F_INTH_DISABLE_ONE_IT(C_INTH_TGSM_IT);
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1354 #else
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1355 INTH_DISABLEONEIT(IQ_TGSM); // mask TGSM int.
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1356 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1357
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1358 #if (CHIPSET == 12) \|\| (CHIPSET == 15)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1359 int_id = ((* (SYS_UWORD16 *) C_INTH_B_IRQ_REG) & C_INTH_SRC_NUM);// For debug: Save IRQ that causes the waking up
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1360 if ( int_id >= 256 )
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1361 int_id = ((* (SYS_UWORD16 *) C_INTH_B_FIQ_REG) & C_INTH_SRC_NUM)+100;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1362 #else
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1363 int_id = ((* (SYS_UWORD16 *) INTH_B_IRQ_REG) & INTH_SRC_NUM);// For debug: Save IRQ that causes the waking up
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1364 if ( int_id >= 256 )
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1365 int_id = ((* (SYS_UWORD16 *) INTH_B_FIQ_REG) & INTH_SRC_NUM)+100;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1366 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1367
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1368 // clear pending IQ_FRAME it and unmask it
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1369 #if (CHIPSET == 12) \|\| (CHIPSET == 15)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1370 F_INTH_RESET_ONE_IT(C_INTH_FRAME_IT);
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1371 F_INTH_ENABLE_ONE_IT(C_INTH_FRAME_IT); // Unmask FRAME int.
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1372 #else
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1373 INTH_RESETONEIT(IQ_FRAME); // clear TDMA IRQ
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1374 INTH_ENABLEONEIT(IQ_FRAME); // Unmask FRAME int.
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1375 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1376
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1377 #if (CHIPSET == 8)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1378 // if deep sleep
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1379 if ( l1s.pw_mgr.sleep_performed == CLOCK_STOP )
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1380 {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1381 UWORD8 i;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1382
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1383 // Loop with check whether DPLL is locked: 100 us max.
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1384 for (i=0;i<16;i++)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1385 {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1386 if (DPLL_READ_DPLL_LOCK)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1387 break;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1388 }
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1389 wait_ARM_cycles(convert_nanosec_to_cycles(50000)); // 50us
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1390
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1391 // Enable DPLL
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1392 //--------------------------------------------------
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1393 DPLL_SET_PLL_ENABLE;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1394
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1395 // Loop with check whether DPLL is locked: 100 us max.
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1396 for (i=0;i<16;i++)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1397 {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1398 if (DPLL_READ_DPLL_LOCK)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1399 break;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1400 }
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1401 wait_ARM_cycles(convert_nanosec_to_cycles(50000)); // 50us
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1402 } // if deep sleep
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1403
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1404 #endif // CHIPSET == 8
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1405
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1406 //=================================================
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1407 //Restart PERIPHERALS clocks if necessary after a big sleep period
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1408 // WARNING: restart other clocks modules!!!
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1409 //=================================================
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1410
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1411
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1412 #if(CHIPSET == 15)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1413 if(l1s.pw_mgr.sleep_performed == FRAME_STOP )
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1414 {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1415
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1416 //ABB_Wakeup_BS(); //Not Used
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1417 //DBB_Wakeup_BS(); //Not Used
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1418 }
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1419 #else
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1420 // if big sleep
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1421 if ( l1s.pw_mgr.sleep_performed == FRAME_STOP )
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1422 {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1423
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1424 UWORD16 clocks_stopped;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1425 clocks_stopped = (l1s.pw_mgr.clocks & l1s.pw_mgr.modules_status);
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1426 if((clocks_stopped & ARMIO_CLK_CUT) == ARMIO_CLK_CUT)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1427 ((volatile UWORD16 )ARMIO_CNTL_REG) \|= ARMIO_CLOCKEN;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1428 if((clocks_stopped & UWIRE_CLK_CUT) == UWIRE_CLK_CUT)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1429 ((volatile UWORD16 )(MEM_UWIRE + 0x8)) \|= 0x0001;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1430
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1431 }
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1432 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1433
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1434
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1435 /***************************************************/
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1436 /* Compute effective sleeping time .... */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1437 /* */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1438 /* sleep duration is */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1439 /* - TIMER_INIT */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1440 /* - or TIMER_INIT - TIMER_VALUE */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1441 /* */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1442 /* "frame_adjust" = TRUE for unschedules wake-up */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1443 /* FALSE for scheduled wake-up */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1444 /***************************************************/
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1445 l1s.pw_mgr.frame_adjust = l1s_compute_wakeup_ticks();
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1446
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1447 #if (TRACE_TYPE !=0 ) && (TRACE_TYPE != 2) && (TRACE_TYPE != 3)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1448 if ((l1s.pw_mgr.frame_adjust == TRUE))
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1449 wakeup_type = WAKEUP_BY_ASYNC_INTERRUPT;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1450 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1451
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1452
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1453 /* Fix Frame */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1454
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1455 l1s_recover_Frame();
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1456
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1457
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1458 /* Fix Hardware Timers */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1459 /* */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1460 /* GSM 1.0 : ntd - timer clock not cut */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1461 /* */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1462 /* GSM 1.5 : deep sleep - need to fix timers */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1463
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1464 if (l1s.pw_mgr.sleep_performed == CLOCK_STOP)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1465 l1s_recover_HWTimers();
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1466
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1467
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1468 /* Fix Os */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1469
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1470 if (Cust_recover_Os()) l1s.pw_mgr.Os_ticks_required = TRUE;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1471 }
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1472 #else // SIMULATION part
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1473 // update L1 timers (FN,...)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1474 l1s_recover_Frame();
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1475 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1476 }
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1477
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1478
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1479
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1480 /* l1s_wakeup_adjust() */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1481 /* Description: 1 frame adjust a fter unscheduled wake-up */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1482 /* This function fix the : */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1483 /* - system clock */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1484 /* - Nucleus timers */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1485 /* - L1 frame counter */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1486 /* - L1 next task counter */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1487 /* - Hardware timers */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1488
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1489
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1490 void l1s_wakeup_adjust ()
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1491 {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1492 #if (CODE_VERSION != SIMULATION)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1493 if (l1_config.pwr_mngt == PWR_MNGT)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1494 {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1495
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1496 UWORD32 previous_sleep_time;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1497
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1498 /***************************************************/
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1499 // Freeze GSM Timer .... */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1500 /***************************************************/
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1501 ULDP_TIMER_FREEZE;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1502
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1503 /***************************************************/
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1504 // Compute effective sleeping time ....
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1505 //
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1506 // compute sleep duration
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1507 // - TIMER_INIT
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1508 // - or TIMER_INIT - TIMER_VALUE
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1509 /***************************************************/
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1510 // save sleep duration that was computed at "unscheduled wakeup"
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1511 previous_sleep_time = l1s.pw_mgr.sleep_duration;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1512
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1513 l1s_compute_wakeup_ticks();
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1514
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1515 // reset flag for adjustment request ....
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1516 l1s.pw_mgr.frame_adjust = FALSE;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1517
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1518 // fix sleep duration
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1519 // => compute difference with duration computed at
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1520 // "unscheduled wakeup"
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1521 l1s.pw_mgr.sleep_duration -= previous_sleep_time;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1522
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1523 // adjust system with 1 frame IF NECESSARY ....
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1524 if (l1s.pw_mgr.sleep_duration)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1525 {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1526 /***************************************************/
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1527 /* Fix Frame */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1528 /***************************************************/
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1529 l1s_recover_Frame();
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1530
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1531 /***************************************************/
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1532 /* Fix Os */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1533 /***************************************************/
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1534 if (Cust_recover_Os()) l1s.pw_mgr.Os_ticks_required = TRUE;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1535 }
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1536 }
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1537 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1538 }
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1539
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1540
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1541 /-------------------------------------------------------/
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1542 /* l1s_compute_wakeup_Ticks() */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1543 /-------------------------------------------------------/
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1544 /* */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1545 /* Description: wake-up */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1546 /* ------------ */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1547 /* This function compute the sleep duration according to */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1548 /* current value of count down counter. */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1549 /* - if TIMER_VALUE = 0 it returns TIMER_INIT */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1550 /* - else it returns TIMER_INIT-TIMER_VALUE*/
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1551 /* */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1552 /-------------------------------------------------------/
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1553 BOOL l1s_compute_wakeup_ticks(void)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1554 {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1555 UWORD16 temp_clear_intr;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1556 #if (CODE_VERSION != SIMULATION)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1557 // read current value of count down counter
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1558 l1s.pw_mgr.sleep_duration = READ_ULDP_TIMER_VALUE;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1559
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1560 // if count down=0 it's a scheduled wake-up....
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1561 if (l1s.pw_mgr.sleep_duration == 0)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1562 {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1563 // read sleeping planned value in TPU INIT register
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1564 l1s.pw_mgr.sleep_duration = READ_ULDP_TIMER_INIT;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1565 // INTH is different from the ULPD interrupt -> aynchronous wakeup
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1566 #if (CHIPSET == 12) \|\| (CHIPSET == 15)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1567 if (int_id != C_INTH_TGSM_IT)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1568 #else
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1569 if (int_id != IQ_TGSM)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1570 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1571 {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1572 wakeup_type = WAKEUP_ASYNCHRONOUS_ULPD_0;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1573 // RESET IT_ULPD in ULPD module
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1574 // The ULDP_GSM_TIMER_IT_REG is a read only register and is cleared on reading the register
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1575 temp_clear_intr =(* (volatile UWORD16 *) ULDP_GSM_TIMER_IT_REG) & ULPD_IT_TIMER_GSM;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1576 #if (CHIPSET == 12) \|\| (CHIPSET == 15)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1577 // RESET IQ_TGSM (IT_ULPD) in IT register
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1578 F_INTH_RESET_ONE_IT(C_INTH_TGSM_IT);
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1579 // RESET IQ_FRAME in IT register
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1580 F_INTH_RESET_ONE_IT(C_INTH_FRAME_IT);
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1581 int_id = C_INTH_TGSM_IT;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1582 #else
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1583 // RESET IQ_TGSM (IT_ULPD) in IT register
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1584 INTH_RESETONEIT(IQ_TGSM);
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1585 // RESET IQ_FRAME in IT register
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1586 INTH_RESETONEIT(IQ_FRAME);
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1587 int_id = IQ_TGSM;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1588 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1589 return(FALSE);
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1590 }
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1591 else
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1592 return(FALSE);
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1593 }
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1594 else // Unscheduled wakeup
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1595 {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1596 // read sleeping planned value in TPU INIT register & compute time elapsed
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1597 l1s.pw_mgr.sleep_duration = READ_ULDP_TIMER_INIT - l1s.pw_mgr.sleep_duration;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1598 return(TRUE);
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1599 }
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1600 #else
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1601 return(FALSE);//omaps00090550
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1602 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1603 }
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1604
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1605 /-------------------------------------------------------/
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1606 /* l1s_recover_Frame() */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1607 /-------------------------------------------------------/
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1608 /* */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1609 /* Description: adjust layer1 data from sleep duration */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1610 /* ------------ */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1611 /-------------------------------------------------------/
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1612 void l1s_recover_Frame(void)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1613 {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1614 if (l1_config.pwr_mngt == PWR_MNGT)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1615 {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1616 /***************************************************/
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1617 /* Fix Frame counters . */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1618 /***************************************************/
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1619 l1s.debug_time += l1s.pw_mgr.sleep_duration; // used for debug and by L3 scenario.
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1620
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1621 // Time...
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1622 // Update "actual time".
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1623 l1s_increment_time(&(l1s.actual_time), l1s.pw_mgr.sleep_duration);
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1624
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1625 // Update "next time".
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1626 l1s.next_time = l1s.actual_time;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1627 l1s_increment_time(&(l1s.next_time), 1); // Next time is actual_time + 1
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1628
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1629 #if L1_GPRS
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1630 // Update "next plus time".
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1631 l1s.next_plus_time = l1s.next_time;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1632 l1s_increment_time(&(l1s.next_plus_time), 1); // Next_plus time is next_time + 1
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1633 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1634
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1635 #if (TRACE_TYPE == 1) \|\| (TRACE_TYPE == 4)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1636 trace_fct(CST_L1S_ADJUST_TIME, (UWORD32)(-1));
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1637 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1638
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1639 // Multiframe table...
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1640 // Increment active frame % mftab size.
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1641 l1s.afrm = (l1s.afrm + l1s.pw_mgr.sleep_duration) % MFTAB_SIZE;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1642
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1643 // Control function counters...
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1644 // Increment frame count from last AFC update.
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1645 l1s.afc_frame_count+= l1s.pw_mgr.sleep_duration;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1646 // reset counter to mask SNR/TOA results for 2 fr.
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1647 #if (TOA_ALGO == 2)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1648 l1s.toa_var.toa_snr_mask=0;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1649 #else
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1650 l1s.toa_snr_mask=0;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1651 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1652
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1653 /***************************************************/
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1654 /* Fix next L1S task counter */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1655 /***************************************************/
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1656 // Decrement time to next L1S task.
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1657 if((l1a_l1s_com.time_to_next_l1s_task > 0) &&
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1658 (l1a_l1s_com.time_to_next_l1s_task < MAX_FN))
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1659 l1a_l1s_com.time_to_next_l1s_task -= l1s.pw_mgr.sleep_duration;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1660 } // l1_config.pwr_mngt == PWR_MNGT
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1661 }
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1662
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1663
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1664 /-------------------------------------------------------/
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1665 /* l1s_recover_HWTimers() */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1666 /-------------------------------------------------------/
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1667 /* */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1668 /* Description: adjust hardware timers from sleep */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1669 /* ------------ duration */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1670 /* */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1671 /* Timers clocks are enabled after VTCX0+SLICER+13MHZ */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1672 /* setup times. So sleep duration is : */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1673 /* GSM TIMER - SETUP_FRAME + SETUP_SLICER + SETUP_VTCXO */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1674 /* + SETUP_CLK13 */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1675 /-------------------------------------------------------/
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1676
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1677 void l1s_recover_HWTimers(void)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1678 {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1679 #if (CODE_VERSION != SIMULATION)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1680
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1681 #define SETUP_FRAME_IN_CLK32 (SETUP_FRAME4.61532.768)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1682 #if (CHIPSET == 15)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1683 #define DELTA_TIME (0)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1684 #else
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1685 #define DELTA_TIME (SETUP_FRAME_IN_CLK32 -SETUP_SLICER - SETUP_VTCXO)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1686 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1687
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1688
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1689 if (l1_config.pwr_mngt == PWR_MNGT)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1690 {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1691 WORD32 timer1,timer2,timer;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1692 #if (CHIPSET == 12) \|\| (CHIPSET == 15)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1693 WORD32 timer_sec;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1694 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1695 UWORD16 cntlreg;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1696 UWORD16 modereg;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1697 double duration;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1698
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1699
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1700 //WORD32 old;- OMAPS 90550 new
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1701
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1702 // read Hercules Timers & Watchdog
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1703 //=================================================
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1704 // Tint = Tclk * (LOAD_TIM+1) * 2^(PTV+1)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1705 // Tclk = 1.2308us for Fclk=13Mhz
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1706 // PTV = 7 (pre-scaler field)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1707 //-------------------------------------------------
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1708
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1709 cntlreg = Dtimer1_Get_cntlreg();
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1710 if ( (cntlreg & D_TIMER_RUN) == D_TIMER_RUN)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1711 {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1712 #if 0 /* match TCS211 object */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1713 cntlreg = cntlreg&0x1F;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1714 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1715 cntlreg >>= 2; // take PTV
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1716 cntlreg = 1 << (cntlreg+1); // compute 2^(PTV+1)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1717 // convert sleep duration in HWTimers ticks....
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1718 duration = (l1s.pw_mgr.sleep_duration * 4.615 - (DELTA_TIME/32.768)) / (cntlreg * 0.0012308);
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1719 #if 0 /* match TCS211 object */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1720 if (duration < 0.0){
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1721 duration = 0.0; // This needs to be done for all the timers
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1722 }
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1723 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1724 timer1 = Dtimer1_ReadValue() - (UWORD16) duration;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1725
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1726 Dtimer1_Start(0);
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1727 Dtimer1_WriteValue(timer1);
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1728 Dtimer1_Start(1);
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1729 }
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1730
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1731 cntlreg = Dtimer2_Get_cntlreg();
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1732 if ( (cntlreg & D_TIMER_RUN) == D_TIMER_RUN)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1733 {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1734 #if 0 /* match TCS211 object */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1735 cntlreg = cntlreg&0x1F;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1736 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1737 cntlreg >>= 2; // take PTV
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1738 cntlreg = 1 << (cntlreg+1);
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1739 // convert sleep duration in HWTimers ticks....
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1740 duration = (l1s.pw_mgr.sleep_duration * 4.615 - (DELTA_TIME/32.768)) / (cntlreg * 0.0012308);
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1741 #if 0 /* match TCS211 object */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1742 if (duration < 0.0){
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1743 duration = 0.0; // This needs to be done for all the timers
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1744 }
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1745 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1746 timer2 = Dtimer2_ReadValue() - (UWORD16) duration;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1747 Dtimer2_Start(0);
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1748 Dtimer2_WriteValue(timer2);
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1749 Dtimer2_Start(1);
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1750 }
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1751
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1752 cntlreg = TIMER_Read(0);
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1753 modereg = TIMER_Read(2);
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1754 if ( (cntlreg & TIMER_ST) \|\| (modereg & TIMER_WDOG))
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1755 {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1756 // in watchdog mode PTV is forced to 7
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1757 if ( modereg & TIMER_WDOG )
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1758 cntlreg \|= TIMER_PTV;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1759
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1760 cntlreg = (cntlreg & TIMER_PTV) >> 9; // take PTV
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1761 cntlreg = 1 << (cntlreg+1);
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1762 // convert sleep duration in HWTimers ticks....
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1763 duration = (l1s.pw_mgr.sleep_duration * 4.615 - (DELTA_TIME/32.768)) / (cntlreg * 0.001078);
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1764
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1765 timer = TIMER_ReadValue() - (UWORD16) duration;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1766 TIMER_START_STOP(0);
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1767 TIMER_WriteValue(timer);
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1768 TIMER_START_STOP(1);
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1769 }
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1770
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1771 #if (CHIPSET == 12) \|\| (CHIPSET == 15)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1772 cntlreg = TIMER_SEC_Read(0);
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1773 modereg = TIMER_SEC_Read(2);
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1774 if ( (cntlreg & TIMER_ST) \|\| (modereg & TIMER_WDOG))
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1775 {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1776 // in watchdog mode PTV is forced to 7
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1777 if ( modereg & TIMER_WDOG )
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1778 cntlreg \|= TIMER_PTV;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1779
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1780 cntlreg = (cntlreg & TIMER_PTV) >> 9; // take PTV
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1781 cntlreg = 1 << (cntlreg+1);
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1782 // convert sleep duration in HWTimers ticks....
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1783 duration = (l1s.pw_mgr.sleep_duration * 4.615 - (DELTA_TIME/32.768)) / (cntlreg * 0.001078);
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1784
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1785 timer_sec = TIMER_SEC_ReadValue() - (UWORD16) duration;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1786 TIMER_SEC_START_STOP(0);
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1787 TIMER_SEC_WriteValue(timer_sec);
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1788 TIMER_SEC_START_STOP(1);
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1789 }
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1790 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1791
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1792 }
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1793 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1794 }
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1795 /-------------------------------------------------------/
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1796 /* l1s_get_next_gauging_in_Packet_Idle() */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1797 /-------------------------------------------------------/
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1798 /* */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1799 /* Description: */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1800 /* ------------ */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1801 /* return the nbr of frames before the next gauging */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1802 /* return -1 means no activity planned */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1803 /-------------------------------------------------------/
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1804 #if L1_GPRS
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1805 UWORD32 next_gauging_scheduled_for_PNP; // gauging for Packet Idle
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1806
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1807 WORD32 l1s_get_next_gauging_in_Packet_Idle(void)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1808 {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1809 WORD32 next_gauging;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1810
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1811 // gauging performed with Normal Paging (we are in Idle mode)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1812 if (l1a_l1s_com.l1s_en_task[NP] == TASK_ENABLED)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1813 return (-1); // no activity planned
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1814
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1815 // we are not in Packet Idle Mode
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1816 if (l1a_l1s_com.l1s_en_task[PNP] != TASK_ENABLED)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1817 return (-1); // no activity planned
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1818
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1819 next_gauging = next_gauging_scheduled_for_PNP - l1s.actual_time.fn ;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1820 if (next_gauging < 0)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1821 next_gauging+=MAX_FN;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1822
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1823 if (next_gauging <= MIN_SLEEP_TIME)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1824 return(0);
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1825
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1826 return (next_gauging);
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1827 }
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1828 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1829 /-------------------------------------------------------/
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1830 /* l1s_gauging_decision_with_PNP() */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1831 /-------------------------------------------------------/
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1832 /* */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1833 /* Description: */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1834 /* ------------ */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1835 /* */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1836 /-------------------------------------------------------/
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1837 #if L1_GPRS
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1838 BOOL l1s_gauging_decision_with_PNP(void)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1839 {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1840 #define TWO_SECONDS_IN_FRAME (UWORD16)(2000/4.615)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1841
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1842 /* reconstructed TCS211 code */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1843 if (l1s.actual_time.fn >= next_gauging_scheduled_for_PNP)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1844 {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1845 next_gauging_scheduled_for_PNP = l1s.actual_time.fn + TWO_SECONDS_IN_FRAME;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1846 if (next_gauging_scheduled_for_PNP >= MAX_FN) next_gauging_scheduled_for_PNP -= MAX_FN;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1847 return (TRUE);
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1848 }
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1849
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1850 return (FALSE); // do not perform gauging
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1851 }
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1852 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1853 /-------------------------------------------------------/
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1854 /* l1s_gauging_decision_with_NP() */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1855 /-------------------------------------------------------/
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1856 /* */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1857 /* Description: */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1858 /* ------------ */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1859 /* */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1860 /-------------------------------------------------------/
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1861 BOOL l1s_gauging_decision_with_NP(void)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1862 {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1863
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1864 static UWORD8 time_to_gaug;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1865
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1866 // a paging is scheduled or , was scheduled but discarded by a higher priority task
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1867 if (l1s.pw_mgr.paging_scheduled == TRUE)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1868 {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1869 l1s.pw_mgr.paging_scheduled = FALSE; // reset Flag.
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1870
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1871 // A gauging session is needed : start gauging session with this paging bloc !
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1872
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1873 //Nina modify to save power, not forbid deep sleep, only force gauging in next paging
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1874 // FreeCalypso TCS211 reconstruction: Nina's change reverted
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1875 #if 1
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1876 if (l1s.pw_mgr.enough_gaug != TRUE)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1877 time_to_gaug = 0;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1878 #else
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1879 if ((l1s.pw_mgr.enough_gaug != TRUE)\|\|(l1s.force_gauging_next_paging_due_to_CCHR == 1))
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1880 {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1881 time_to_gaug = 0;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1882 l1s.force_gauging_next_paging_due_to_CCHR = 0;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1883 }
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1884 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1885 if (time_to_gaug > 0)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1886 {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1887 time_to_gaug--; // perform the gauging with an another paging.
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1888 }
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1889 else // perform the gauging with this paging
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1890 {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1891 if (l1s.task_status[NP].current_status == ACTIVE )
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1892 {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1893 time_to_gaug = GAUG_VS_PAGING_RATE[l1a_l1s_com.bs_pa_mfrms-2]-1;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1894
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1895 return (TRUE); // gauging allowed
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1896 }
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1897 else // a gauging is scheduled to be perform here but the paging is missing
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1898 { // (paging discarded by a higher priority task ?)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1899 l1s.pw_mgr.enough_gaug= FALSE; // forbid Deep sleep until next gauging
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1900 }
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1901 }
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1902 }
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1903 return (FALSE); // gauging not allowed
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1904 }
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1905
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1906 /*************************************************************/
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1907 /* Gauging task management : */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1908 /* */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1909 /* CALYPSO */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1910 /* */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1911 /* 9 8 7 6 5 4 3 2 1 0 */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1912 /* C0 C1 C2 C3 C4 W R - - - */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1913 /* \| \| */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1914 /* \| \| */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1915 /* \|_ start gauging \|_ stop gauging */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1916 /* */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1917 /OTHERS: /
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1918 /* */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1919 /* 11 10 9 8 7 6 5 4 3 2 1 0 */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1920 /* C0 C1 C2 C3 C4 W R - - - - - */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1921 /* \| \| \| \| \| */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1922 /* \| \| \|_ start gauging \|_ stop gauging */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1923 /* \| \| \| \| */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1924 /* \| \|_ (ITCOM) \| \|(ITCOM) */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1925 /* \| \| */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1926 /* \|_ pgm PLL \|_restore PLL */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1927 /* */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1928 /* */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1929 /*************************************************************/
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1930 void l1s_gauging_task(void)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1931 {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1932 if (l1_config.pwr_mngt == PWR_MNGT)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1933 {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1934 /*************************************************************/
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1935 if (l1s.pw_mgr.gauging_task == ACTIVE)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1936 {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1937 /*************************************************************/
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1938 // COUNT = 10 ==> PLL is at 65 Mhz, start the gauging
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1939 /*************************************************************/
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1940 #if (CHIPSET==7) \|\| (CHIPSET == 8) \|\| (CHIPSET == 10) \|\| (CHIPSET == 11) \|\| (CHIPSET == 12) \|\| (CHIPSET == 15)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1941 // the gauging was started with the begining of the paging
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1942 #else
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1943 if (l1s.pw_mgr.gaug_count == (l1s.pw_mgr.gaug_duration-1))
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1944 {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1945 #if (CODE_VERSION != SIMULATION)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1946 ULDP_GAUGING_START; // start gauging
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1947 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1948
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1949 #if (TRACE_TYPE != 0)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1950 #if (GSM_IDLE_RAM != 0)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1951 l1_trace_gauging_intram();
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1952 #else
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1953 l1_trace_gauging();
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1954 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1955 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1956 }
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1957 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1958
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1959 l1s.pw_mgr.gaug_count--; // decrement counter
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1960
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1961
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1962 // When a MISC task is enabled L1S must be ran every frame
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1963 // to be able to enable the frame interrupt for DSP
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1964 l1a_l1s_com.time_to_next_l1s_task = 0;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1965 }
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1966
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1967 /*************************************************************/
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1968 // REQUEST A GAUGING PROCESS ON EACH PAGING BLOCK
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1969 // IN IDLE MODE .....
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1970 /*************************************************************/
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1971
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1972 else if (l1s.pw_mgr.gauging_task == INACTIVE )
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1973 {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1974 BOOL decision = FALSE;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1975
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1976 if (l1a_l1s_com.l1s_en_task[NP] == TASK_ENABLED)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1977 decision = l1s_gauging_decision_with_NP();
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1978 #if L1_GPRS
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1979 else
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1980 if (l1a_l1s_com.l1s_en_task[PNP] == TASK_ENABLED)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1981 decision = l1s_gauging_decision_with_PNP();
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1982 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1983
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1984 if (decision == TRUE)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1985 {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1986 // gauging duration
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1987 l1s.pw_mgr.gaug_count = l1s.pw_mgr.gaug_duration;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1988
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1989 #if (CHIPSET==7) \|\| (CHIPSET == 8) \|\| (CHIPSET == 10) \|\| (CHIPSET == 11) \|\| (CHIPSET == 12) \|\| (CHIPSET == 15)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1990 // start ULPD gauging immediately with Calypso because we needn't IT_COM.
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1991 #if (CODE_VERSION != SIMULATION)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1992 ULDP_GAUGING_START;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1993 #if (CHIPSET == 12) \|\| (CHIPSET == 15)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1994 // Force the DPLL to be active
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1995 ( * (volatile SYS_UWORD16 *) CLKM_CNTL_CLK) &= ~(CLKM_DPLL_DIS);
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1996 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1997 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1998
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1999 #if (TRACE_TYPE != 0)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2000 #if (GSM_IDLE_RAM != 0)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2001 l1_trace_gauging_intram();
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2002 #else
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2003 l1_trace_gauging();
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2004 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2005 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2006 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2007
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2008 // DSP programmation .......
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2009 #if (DSP >= 33)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2010 #if (CHIPSET==4)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2011 l1s_dsp_com.dsp_ndb_ptr->d_pll_config \|= B_32KHZ_CALIB;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2012 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2013 #else
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2014 l1s_dsp_com.dsp_ndb_ptr->d_pll_clkmod1 = CLKMOD2; // IDLE1 only for DSP
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2015 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2016
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2017 l1s.pw_mgr.gauging_task = ACTIVE;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2018 }
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2019 }
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2020 }
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2021 }
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2022 /-------------------------------------------------------/
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2023 /* l1s_gauging_task_end() */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2024 /-------------------------------------------------------/
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2025 /* */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2026 /* Description: */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2027 /* ------------ */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2028 /* stop the gauging activity */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2029 /-------------------------------------------------------/
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2030 void l1s_gauging_task_end(void)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2031 {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2032 if (l1_config.pwr_mngt == PWR_MNGT)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2033 {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2034 /*************************************************************/
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2035 if (l1s.pw_mgr.gauging_task == ACTIVE)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2036 {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2037 /*************************************************************/
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2038 // COUNT = 1 ==> stop the gauging and free DSP idle modes....
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2039 /*************************************************************/
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2040 if (l1s.pw_mgr.gaug_count == 1)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2041 {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2042 // wait for end of gauging interrupt ...
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2043 l1s.pw_mgr.gauging_task = WAIT_IQ;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2044
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2045 // Unmask ULPD GAUGING int.
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2046 #if (CODE_VERSION != SIMULATION)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2047 #if (CHIPSET == 12) \|\| (CHIPSET == 15)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2048 F_INTH_ENABLE_ONE_IT(C_INTH_ULPD_GAUGING_IT);
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2049 #else
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2050 INTH_ENABLEONEIT(IQ_ULPD_GAUGING);
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2051 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2052 ULDP_GAUGING_STOP; // stop ULPD gauging
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2053 #if (CHIPSET == 12) \|\| (CHIPSET == 15)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2054 // Allow the DPLL to be cut according to ARM sleep mode
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2055 //( * (volatile SYS_UWORD16 *) CLKM_CNTL_CLK) \|= (CLKM_DPLL_DIS);
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2056 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2057 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2058
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2059 // DSP programmation : free IDLE modes...
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2060 #if (DSP >= 33)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2061 #if (CHIPSET==4)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2062 l1s_dsp_com.dsp_ndb_ptr->d_pll_config &= ~B_32KHZ_CALIB;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2063 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2064 #else
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2065 l1s_dsp_com.dsp_ndb_ptr->d_pll_clkmod1 = CLKMOD1;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2066 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2067
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2068
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2069 #if (CODE_VERSION == SIMULATION)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2070 // in order to simulate the Gauging interrupt
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2071 GAUGING_Handler();
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2072
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2073 #if (TRACE_TYPE==5)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2074 trace_ULPD("Stop Gauging", l1s.actual_time.fn);
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2075 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2076 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2077 }
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2078 }
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2079 }
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2080 }
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2081
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2082 //#pragma GSM_IDLE_DUPLICATE_FOR_INTERNAL_RAM_END
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2083 #endif

FreeCalypso > hg > fc-magnetite

annotate src/cs/layer1/cfile/l1_pwmgr.c @ 702:9394305d4ff5 default tip