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

annotate src/cs/layer1/cfile/l1_pwmgr.c @ 547:c3f2f79dc5b8

l1_rf12.c compiled-in default RF band tables: a round of cleanup * Uncalibrated default g_magic values changed from old Clara RF numbers (yes, Clara, not even Leonardo) to the approximately correct value for our current hw; * Uncalibrated default Rx and Tx channel calibration tables providing neutral correction values: fixed bogus ARFCNs from blind copy-n-paste between different bands; * Restored #if (ORDER2_TX_TEMP_CAL==1) in the Tx temperature compensation tables; * Fully rewrote the big comment before these rf_XXX structures to reflect the current situation. This change is part of the larger transition in FreeCalypso from reverse to forward engineering, from reconstruction of lost original bits to ongoing forward development and maintenance.

author	Mychaela Falconia <falcon@freecalypso.org>
date	Sat, 17 Nov 2018 19:57:34 +0000
parents	daddb933047d
children	dc1e0a1c100f

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
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	785 WORD32 time_from_last_wakeup=0;
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
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	796 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	797
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	798 //=================================================
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	799 // check System (SIM, UART, LDC ..... )
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	800 //=================================================
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	801 sleep_mode = Cust_check_system();
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	802
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	803 if (sleep_mode == DO_NOT_SLEEP)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	804 return;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	805
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	806 #if (CODE_VERSION != SIMULATION)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	807 //=================================================
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	808 // Protect System structures
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	809 // 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	810 // 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	811 //=================================================
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	812 OS_system_protect();
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	813 //=================================================
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	814 // Disable IRQ
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	815 //=================================================
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	816 INT_DisableIRQ();
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	817 #endif // NOT SIMULATION
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	818
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	819 //=================================================
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	820 // check OS loading
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	821 //=================================================
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	822 min_time = OS_get_inactivity_ticks();
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 //=================================================
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	825 // check HW Timers loading
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	826 //=================================================
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	827 HWtimer= l1s_get_HWTimers_ticks();
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	828
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	829 //=================================================
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	830 // 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	831 //=================================================
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	832 #if L1_GPRS
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	833 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	834 #else
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	835 min_time_gauging = -1; // not used
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	836 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	837
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	838 #if (OP_BT == 1)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	839 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	840 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	841 // check if immediate activity planned
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	842 // 0 means immediate activity
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	843 // 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	844 // 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	845 // 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	846 /*
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	847 * FreeCalypso change: the abstention from big sleep because of UART or SIM
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	848 * has been moved into Cust_check_system(), which now returns DO_NOT_SLEEP
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	849 * in these cases, while still returning FRAME_STOP if the cause is
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	850 * the backlight or charging.
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	851 */
69 50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	852 if ( !min_time
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	853 \|\| !HWtimer
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	854 \|\| !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	855 #if 0 /* FreeCalypso change */
69 50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	856 \|\| (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	857 #endif
69 50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	858 #if (OP_BT == 1)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	859 \|\| !hci_ll_status
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	860 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	861 )
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	862 {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	863
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	864
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	865 #if (CODE_VERSION != SIMULATION)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	866 OS_system_Unprotect();
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	867 // free System structure
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	868 // Enable all IRQ
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	869 INT_EnableIRQ();
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	870 // Wake up UART
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	871
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	872 SER_WakeUpUarts(); // Wake up Uarts
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	873
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	874 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	875 return;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	876 }
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	877 //=================================================
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	878 // Select sleep duration ....
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	879 //=================================================
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	880 // remember: -1 means no activity planned
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	881 //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	882 //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	883 //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	884
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	885 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	886 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	887 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	888 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	889
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	890 #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	891 // to trace the Wake up source
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	892 // 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	893 wakeup_type = WAKEUP_FOR_OS_TASK;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	894 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	895 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	896 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	897 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	898
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	899 //=================================================
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	900 // Choose DEEP or BIG SLEEP
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 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	903 ((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	904 {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	905 // 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	906 #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	907 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	908 ( 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	909 #else
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	910 #if (CHIPSET == 12) \|\| (CHIPSET == 15)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	911 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	912 !CLKM_READ_nIDLE3)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	913 #else
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	914 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	915 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	916 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	917 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	918 else
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 // 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	921 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	922 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	923 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	924 else
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	925 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	926 }
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	927 }
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	928 if (l1s.pw_mgr.mode_authorized == BIG_SLEEP)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	929 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	930
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	931 if ( ((l1s.pw_mgr.mode_authorized == BIG_SLEEP) && (sleep_mode >= FRAME_STOP)) \|\|
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	932 ((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	933 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	934
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	935
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	936 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	937 {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	938 #if (CODE_VERSION != SIMULATION)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	939 OS_system_Unprotect(); // free System structure
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	940 INT_EnableIRQ(); // Enable all IRQ
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	941
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	942 SER_WakeUpUarts(); // Wake up Uarts
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	943
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	944 #endif // NOT SIMULATION
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	945 return;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	946 }
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	947
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	948 // update previous sleep
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	949 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	950
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	951
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	952 #if (CODE_VERSION != SIMULATION)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	953
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	954 #if (CHIPSET == 12) \|\| (CHIPSET == 15)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	955 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	956 #else
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	957 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	958 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	959 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	960
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 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	963 // if FRAME_STOP : asleep Omega, SPI
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	964 //=====================================================
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	965 #if (CODE_VERSION != SIMULATION)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	966 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	967 {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	968 // ==== STop RF and TPU..... ===================
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	969
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	970 //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	971
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	972
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	973 l1dmacro_RF_sleep();
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	974
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	975 // ((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	976 // 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	977 // ((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	978
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	979 //===== SET default value for gauging =========
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	980 // 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	981 // 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	982 // (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	983 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	984 {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	985 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	986 }
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	987 }
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
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	990 //==============================================
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	991 // 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	992 //==============================================
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	993 #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	994 // 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	995 ( * (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	996 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	997
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	998 //==============================================
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	999 // 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	1000 //==============================================
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1001 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	1002
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1003 #if (OP_BT == 1)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1004 hci_ll_go_to_sleep();
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1005 #endif
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 // STop SPI .....
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1008 //=================================================
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 )MEM_SPI)&=0xFFFE; // SPI CLK DISABLED
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1011 #endif // NOT SIMULATION
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1012
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 //=================================================
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1015 // 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	1016 // 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	1017 // restored at wake up
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1018 //=================================================
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1019 #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	1020 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	1021 f_memif_extended_page_mode_disable();
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1022 #endif
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 // Init the timer :
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1026 //
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1027 // 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	1028 // 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	1029 // 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	1030 // 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	1031 //
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1032 // 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	1033 // 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	1034 //
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 //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	1037 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	1038 {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1039 // 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	1040 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	1041 }
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1042 else
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1043 // BIG SLEEP
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1044 wake_up_time = min_time - 1;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1045
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1046
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 #if (CODE_VERSION != SIMULATION)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1049 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	1050 ULDP_TIMER_INIT(MAX_GSM_TIMER);
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1051 else
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1052 ULDP_TIMER_INIT(wake_up_time);
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 ULDP_TIMER_LD; // Load the timer
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1055
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1056 // 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	1057 // 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	1058 // 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	1059 // Clear it into the ULPD...
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1060 // 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	1061 //reading the register.
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1062 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	1063 // ... 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	1064
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1065 #if (CHIPSET == 12) \|\| (CHIPSET == 15)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1066 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	1067 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	1068 #else
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1069 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	1070 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	1071 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1072
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1073 #if (GSM_IDLE_RAM != 0)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1074 if (READ_TRAFFIC_CONT_STATE)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1075 {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1076 CSMI_TrafficControllerOff();
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1077 }
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1078 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1079
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1080 ULDP_TIMER_START; // start count down
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 (GSM_IDLE_RAM_DEBUG == 1)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1084 (( 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	1085 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1086
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1087 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	1088 // DEEP SLEEP
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1089 {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1090 #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	1091 // specific sleep for WCP
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1092 arm7_deep_sleep();
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1093 #else // NO OP_WCP
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1094 #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	1095 f_arm_sleep_cmd(DEEP_SLEEP);
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1096 #else
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1097 ((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	1098 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1099 #endif // OP_WCP
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1100 }
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1101 else
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1102 {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1103 // 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	1104
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1105 //==========================================================
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1106 //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	1107 //==========================================================
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1108
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1109 UWORD16 clocks_stopped; //OMAPS90550- new
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1110 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	1111 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	1112 ((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	1113 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	1114 ((volatile UWORD16 )(MEM_UWIRE + 0x8)) &= ~(0x0001);
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1115
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1116 #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	1117 f_arm_sleep_cmd(BIG_SLEEP);
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1118 #else
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1119
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1120 ((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	1121 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1122 }
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1123 #else // Simulation part
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1124 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	1125 hw.deep_sleep_en = 1;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1126 status = NU_Suspend_Task(&L1S_task);
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1127 // check status value...
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1128 if (status)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1129 {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1130 #if (TRACE_TYPE==5)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1131 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	1132 log_sim_error(ERR);
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 EXIT;
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 #endif // SIMULATION
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 //=================================================
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1139 // Wake-up procedure
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 // 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	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 #if (GSM_IDLE_RAM_DEBUG == 1)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1145 (( 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	1146 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1147
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1148
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1149 l1s_wakeup();
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 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	1152
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1153 if (last_wakeup == sleep_time)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1154 // 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	1155 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	1156
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1157 #if (GSM_IDLE_RAM != 0)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1158 // 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	1159 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	1160 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	1161
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1162 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	1163 {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1164 if (!READ_TRAFFIC_CONT_STATE)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1165 {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1166 CSMI_TrafficControllerOn();
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1167 }
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1168 }
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1169 #endif
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 //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	1172 //=================================================
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1173 #if (CODE_VERSION != SIMULATION)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1174 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	1175 {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1176 // ((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	1177 UWORD8 local_sleep_status;
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 l1dmacro_RF_wakeup();
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1180
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1181 }
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 #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	1184 // 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	1185 // 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	1186 ( * (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	1187 #elif (CHIPSET == 12)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1188 // 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	1189 #elif (CHIPSET == 15)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1190 ( * (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	1191 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1192
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1193 //=================================================
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1194 //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	1195 //=================================================
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1196 ((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	1197
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 // Wake up ABB
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 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	1202
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1203 #if (OP_BT == 1)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1204 hci_ll_wake_up();
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1205 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1206 #endif //CODE VERSION
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 //=================================================
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1209 // 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	1210 // 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	1211 //=================================================
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1212 #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	1213 if ( extended_page_mode_state != 0 )
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1214 f_memif_extended_page_mode_enable();
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1215 #endif
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 #if (OP_L1_STANDALONE == 0)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1218 /GC_Wakeup(); OMAPS00134004/
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1219 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1220
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1221 #if (CODE_VERSION != SIMULATION)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1222 //=================================================
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1223 // enable IRQ
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1224 //=================================================
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1225 OS_system_Unprotect();
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 #if (TRACE_TYPE != 0)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1229 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	1230 {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1231 #if (GSM_IDLE_RAM == 0)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1232 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	1233 #else
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1234 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	1235 #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	1236 l1s_trace_mftab();
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1237 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1238 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1239 }
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
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1242 #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	1243 trace_info.sleep_performed = TRUE;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1244 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1245
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1246 #if (CODE_VERSION != SIMULATION)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1247
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1248 //=================================================
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1249 // enable IRQ
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1250 //=================================================
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1251 INT_EnableIRQ();
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1252
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1253 //=================================================
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1254 // 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	1255 // 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	1256 // 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	1257 // 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	1258 // do not add code here after !!!
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1259 // if possible respect this rule !
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1260 //=================================================
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1261
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1262 //=================================================
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1263 // wake-up UARTs
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1264 //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	1265 //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	1266 //=================================================
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1267 {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1268 #if (GSM_IDLE_RAM != 0)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1269 // 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	1270 // 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	1271 // 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	1272 // controller ON during that time.
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1273 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	1274 if (!READ_TRAFFIC_CONT_STATE)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1275 {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1276 flag_traffic_controller_state = 1;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1277 CSMI_TrafficControllerOn();
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1278 }
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1279 #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
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1282 SER_WakeUpUarts(); // Wake up Uarts
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
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1285 #if (GSM_IDLE_RAM != 0)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1286 // 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	1287 // 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	1288 // 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	1289 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	1290 {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1291 CSMI_TrafficControllerOff();
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1292 }
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1293 flag_traffic_controller_state = 0;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1294 #endif
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 #endif // NOT SIMULATION
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 }
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1299
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1300 // l1s_wakeup() */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1301 // 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	1302 // 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	1303 // - system clock
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1304 // - Nucleus timers
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1305 // - L1 frame counter
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1306 // - L1 next task counter
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1307 // - Hardware timers
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1308
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1309 void l1s_wakeup(void)
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 #if (CODE_VERSION != SIMULATION)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1312 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	1313 {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1314 // Restore interrupts ....
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 #if (CHIPSET == 12) \|\| (CHIPSET == 15)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1317 // mask TGSM int.
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1318 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	1319 #else
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1320 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	1321 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1322
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1323 #if (CHIPSET == 12) \|\| (CHIPSET == 15)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1324 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	1325 if ( int_id >= 256 )
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1326 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	1327 #else
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1328 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	1329 if ( int_id >= 256 )
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1330 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	1331 #endif
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 // 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	1334 #if (CHIPSET == 12) \|\| (CHIPSET == 15)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1335 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	1336 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	1337 #else
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1338 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	1339 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	1340 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1341
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1342 #if (CHIPSET == 8)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1343 // if deep sleep
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1344 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	1345 {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1346 UWORD8 i;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1347
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1348 // 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	1349 for (i=0;i<16;i++)
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 (DPLL_READ_DPLL_LOCK)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1352 break;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1353 }
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1354 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	1355
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1356 // Enable DPLL
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 DPLL_SET_PLL_ENABLE;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1359
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1360 // 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	1361 for (i=0;i<16;i++)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1362 {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1363 if (DPLL_READ_DPLL_LOCK)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1364 break;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1365 }
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1366 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	1367 } // if deep sleep
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1368
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1369 #endif // CHIPSET == 8
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1370
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1371 //=================================================
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1372 //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	1373 // WARNING: restart other clocks modules!!!
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1374 //=================================================
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1375
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1376
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1377 #if(CHIPSET == 15)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1378 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	1379 {
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 //ABB_Wakeup_BS(); //Not Used
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1382 //DBB_Wakeup_BS(); //Not Used
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1383 }
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1384 #else
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1385 // if big sleep
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1386 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	1387 {
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 UWORD16 clocks_stopped;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1390 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	1391 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	1392 ((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	1393 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	1394 ((volatile UWORD16 )(MEM_UWIRE + 0x8)) \|= 0x0001;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1395
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1396 }
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1397 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1398
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1399
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 /* Compute effective sleeping time .... */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1402 /* */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1403 /* sleep duration is */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1404 /* - TIMER_INIT */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1405 /* - or TIMER_INIT - TIMER_VALUE */
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 /* "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	1408 /* FALSE for scheduled wake-up */
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 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	1411
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1412 #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	1413 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	1414 wakeup_type = WAKEUP_BY_ASYNC_INTERRUPT;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1415 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1416
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1417
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1418 /* Fix Frame */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1419
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1420 l1s_recover_Frame();
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1421
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 /* Fix Hardware Timers */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1424 /* */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1425 /* 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	1426 /* */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1427 /* 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	1428
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1429 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	1430 l1s_recover_HWTimers();
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
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1433 /* Fix Os */
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 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	1436 }
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1437 #else // SIMULATION part
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1438 // update L1 timers (FN,...)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1439 l1s_recover_Frame();
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1440 #endif
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
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1443
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1444
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1445 /* l1s_wakeup_adjust() */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1446 /* 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	1447 /* This function fix the : */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1448 /* - system clock */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1449 /* - Nucleus timers */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1450 /* - L1 frame counter */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1451 /* - L1 next task counter */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1452 /* - Hardware timers */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1453
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1454
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1455 void l1s_wakeup_adjust ()
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 #if (CODE_VERSION != SIMULATION)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1458 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	1459 {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1460
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1461 UWORD32 previous_sleep_time;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1462
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1463 /***************************************************/
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1464 // Freeze GSM Timer .... */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1465 /***************************************************/
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1466 ULDP_TIMER_FREEZE;
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 /***************************************************/
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1469 // Compute effective sleeping time ....
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1470 //
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1471 // compute sleep duration
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1472 // - TIMER_INIT
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1473 // - or TIMER_INIT - TIMER_VALUE
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1474 /***************************************************/
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1475 // 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	1476 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	1477
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1478 l1s_compute_wakeup_ticks();
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 // reset flag for adjustment request ....
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1481 l1s.pw_mgr.frame_adjust = FALSE;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1482
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1483 // fix sleep duration
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1484 // => compute difference with duration computed at
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1485 // "unscheduled wakeup"
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1486 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	1487
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1488 // 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	1489 if (l1s.pw_mgr.sleep_duration)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1490 {
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 /* Fix Frame */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1493 /***************************************************/
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1494 l1s_recover_Frame();
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 /***************************************************/
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1497 /* Fix Os */
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 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	1500 }
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1501 }
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1502 #endif
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
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 /-------------------------------------------------------/
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1507 /* l1s_compute_wakeup_Ticks() */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1508 /-------------------------------------------------------/
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 /* Description: wake-up */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1511 /* ------------ */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1512 /* 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	1513 /* current value of count down counter. */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1514 /* - 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	1515 /* - 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	1516 /* */
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 BOOL l1s_compute_wakeup_ticks(void)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1519 {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1520 UWORD16 temp_clear_intr;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1521 #if (CODE_VERSION != SIMULATION)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1522 // 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	1523 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	1524
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1525 // 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	1526 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	1527 {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1528 // 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	1529 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	1530 // 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	1531 #if (CHIPSET == 12) \|\| (CHIPSET == 15)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1532 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	1533 #else
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1534 if (int_id != IQ_TGSM)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1535 #endif
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 wakeup_type = WAKEUP_ASYNCHRONOUS_ULPD_0;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1538 // RESET IT_ULPD in ULPD module
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1539 // 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	1540 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	1541 #if (CHIPSET == 12) \|\| (CHIPSET == 15)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1542 // 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	1543 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	1544 // RESET IQ_FRAME in IT register
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1545 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	1546 int_id = C_INTH_TGSM_IT;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1547 #else
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1548 // 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	1549 INTH_RESETONEIT(IQ_TGSM);
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1550 // RESET IQ_FRAME in IT register
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1551 INTH_RESETONEIT(IQ_FRAME);
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1552 int_id = IQ_TGSM;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1553 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1554 return(FALSE);
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1555 }
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1556 else
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1557 return(FALSE);
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1558 }
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1559 else // Unscheduled wakeup
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1560 {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1561 // 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	1562 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	1563 return(TRUE);
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1564 }
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1565 #else
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1566 return(FALSE);//omaps00090550
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1567 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1568 }
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1569
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1570 /-------------------------------------------------------/
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1571 /* l1s_recover_Frame() */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1572 /-------------------------------------------------------/
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1573 /* */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1574 /* 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	1575 /* ------------ */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1576 /-------------------------------------------------------/
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1577 void l1s_recover_Frame(void)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1578 {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1579 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	1580 {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1581 /***************************************************/
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1582 /* Fix Frame counters . */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1583 /***************************************************/
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1584 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	1585
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1586 // Time...
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1587 // Update "actual time".
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1588 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	1589
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1590 // Update "next time".
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1591 l1s.next_time = l1s.actual_time;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1592 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	1593
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1594 #if L1_GPRS
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1595 // Update "next plus time".
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1596 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	1597 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	1598 #endif
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 #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	1601 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	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 // Multiframe table...
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1605 // Increment active frame % mftab size.
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1606 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	1607
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1608 // Control function counters...
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1609 // 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	1610 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	1611 // 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	1612 #if (TOA_ALGO == 2)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1613 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	1614 #else
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1615 l1s.toa_snr_mask=0;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1616 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1617
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1618 /***************************************************/
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1619 /* Fix next L1S task counter */
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 // Decrement time to next L1S task.
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1622 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	1623 (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	1624 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	1625 } // l1_config.pwr_mngt == PWR_MNGT
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1626 }
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1627
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 /-------------------------------------------------------/
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1630 /* l1s_recover_HWTimers() */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1631 /-------------------------------------------------------/
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1632 /* */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1633 /* Description: adjust hardware timers from sleep */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1634 /* ------------ duration */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1635 /* */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1636 /* 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	1637 /* setup times. So sleep duration is : */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1638 /* 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	1639 /* + SETUP_CLK13 */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1640 /-------------------------------------------------------/
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1641
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1642 void l1s_recover_HWTimers(void)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1643 {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1644 #if (CODE_VERSION != SIMULATION)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1645
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1646 #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	1647 #if (CHIPSET == 15)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1648 #define DELTA_TIME (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 #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	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 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	1655 {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1656 WORD32 timer1,timer2,timer;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1657 #if (CHIPSET == 12) \|\| (CHIPSET == 15)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1658 WORD32 timer_sec;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1659 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1660 UWORD16 cntlreg;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1661 UWORD16 modereg;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1662 double duration;
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 //WORD32 old;- OMAPS 90550 new
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 // read Hercules Timers & Watchdog
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1668 //=================================================
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1669 // 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	1670 // Tclk = 1.2308us for Fclk=13Mhz
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1671 // PTV = 7 (pre-scaler field)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1672 //-------------------------------------------------
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1673
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1674 cntlreg = Dtimer1_Get_cntlreg();
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1675 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	1676 {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1677 #if 0 /* match TCS211 object */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1678 cntlreg = cntlreg&0x1F;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1679 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1680 cntlreg >>= 2; // take PTV
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1681 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	1682 // convert sleep duration in HWTimers ticks....
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1683 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	1684 #if 0 /* match TCS211 object */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1685 if (duration < 0.0){
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1686 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	1687 }
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1688 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1689 timer1 = Dtimer1_ReadValue() - (UWORD16) duration;
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 Dtimer1_Start(0);
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1692 Dtimer1_WriteValue(timer1);
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1693 Dtimer1_Start(1);
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1694 }
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1695
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1696 cntlreg = Dtimer2_Get_cntlreg();
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1697 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	1698 {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1699 #if 0 /* match TCS211 object */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1700 cntlreg = cntlreg&0x1F;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1701 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1702 cntlreg >>= 2; // take PTV
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1703 cntlreg = 1 << (cntlreg+1);
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1704 // convert sleep duration in HWTimers ticks....
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1705 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	1706 #if 0 /* match TCS211 object */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1707 if (duration < 0.0){
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1708 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	1709 }
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1710 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1711 timer2 = Dtimer2_ReadValue() - (UWORD16) duration;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1712 Dtimer2_Start(0);
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1713 Dtimer2_WriteValue(timer2);
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1714 Dtimer2_Start(1);
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1715 }
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1716
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1717 cntlreg = TIMER_Read(0);
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1718 modereg = TIMER_Read(2);
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1719 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	1720 {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1721 // 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	1722 if ( modereg & TIMER_WDOG )
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1723 cntlreg \|= TIMER_PTV;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1724
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1725 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	1726 cntlreg = 1 << (cntlreg+1);
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1727 // convert sleep duration in HWTimers ticks....
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1728 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	1729
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1730 timer = TIMER_ReadValue() - (UWORD16) duration;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1731 TIMER_START_STOP(0);
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1732 TIMER_WriteValue(timer);
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1733 TIMER_START_STOP(1);
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1734 }
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1735
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1736 #if (CHIPSET == 12) \|\| (CHIPSET == 15)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1737 cntlreg = TIMER_SEC_Read(0);
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1738 modereg = TIMER_SEC_Read(2);
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1739 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	1740 {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1741 // 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	1742 if ( modereg & TIMER_WDOG )
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1743 cntlreg \|= TIMER_PTV;
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 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	1746 cntlreg = 1 << (cntlreg+1);
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1747 // convert sleep duration in HWTimers ticks....
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1748 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	1749
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1750 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	1751 TIMER_SEC_START_STOP(0);
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1752 TIMER_SEC_WriteValue(timer_sec);
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1753 TIMER_SEC_START_STOP(1);
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1754 }
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1755 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1756
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1757 }
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1758 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1759 }
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1760 /-------------------------------------------------------/
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1761 /* 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	1762 /-------------------------------------------------------/
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1763 /* */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1764 /* Description: */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1765 /* ------------ */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1766 /* 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	1767 /* return -1 means no activity planned */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1768 /-------------------------------------------------------/
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1769 #if L1_GPRS
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1770 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	1771
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1772 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	1773 {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1774 WORD32 next_gauging;
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 // 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	1777 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	1778 return (-1); // no activity planned
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 // 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	1781 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	1782 return (-1); // no activity planned
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1783
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1784 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	1785 if (next_gauging < 0)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1786 next_gauging+=MAX_FN;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1787
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1788 if (next_gauging <= MIN_SLEEP_TIME)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1789 return(0);
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1790
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1791 return (next_gauging);
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 /* l1s_gauging_decision_with_PNP() */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1796 /-------------------------------------------------------/
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 /* Description: */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1799 /* ------------ */
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 /-------------------------------------------------------/
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1802 #if L1_GPRS
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1803 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	1804 {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1805 #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	1806
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1807 /* reconstructed TCS211 code */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1808 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	1809 {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1810 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	1811 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	1812 return (TRUE);
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1813 }
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 return (FALSE); // do not perform gauging
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1816 }
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1817 #endif
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 /* l1s_gauging_decision_with_NP() */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1820 /-------------------------------------------------------/
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1821 /* */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1822 /* Description: */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1823 /* ------------ */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1824 /* */
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 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	1827 {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1828
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1829 static UWORD8 time_to_gaug;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1830
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1831 // 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	1832 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	1833 {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1834 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	1835
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1836 // 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	1837
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1838 //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	1839 // 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	1840 #if 1
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1841 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	1842 time_to_gaug = 0;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1843 #else
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1844 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	1845 {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1846 time_to_gaug = 0;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1847 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	1848 }
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1849 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1850 if (time_to_gaug > 0)
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 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	1853 }
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1854 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	1855 {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1856 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	1857 {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1858 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	1859
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1860 return (TRUE); // gauging allowed
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1861 }
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1862 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	1863 { // (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	1864 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	1865 }
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1866 }
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1867 }
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1868 return (FALSE); // gauging not allowed
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1869 }
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1870
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1871 /*************************************************************/
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1872 /* Gauging task management : */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1873 /* */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1874 /* CALYPSO */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1875 /* */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1876 /* 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	1877 /* 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	1878 /* \| \| */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1879 /* \| \| */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1880 /* \|_ start gauging \|_ stop gauging */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1881 /* */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1882 /OTHERS: /
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 /* 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	1885 /* 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	1886 /* \| \| \| \| \| */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1887 /* \| \| \|_ start gauging \|_ stop gauging */
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 /* \| \|_ (ITCOM) \| \|(ITCOM) */
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 /* \|_ pgm PLL \|_restore PLL */
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 /* */
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 void l1s_gauging_task(void)
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 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	1898 {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1899 /*************************************************************/
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1900 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	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 // 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	1904 /*************************************************************/
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1905 #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	1906 // 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	1907 #else
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1908 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	1909 {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1910 #if (CODE_VERSION != SIMULATION)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1911 ULDP_GAUGING_START; // start gauging
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1912 #endif
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 #if (TRACE_TYPE != 0)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1915 #if (GSM_IDLE_RAM != 0)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1916 l1_trace_gauging_intram();
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1917 #else
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1918 l1_trace_gauging();
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1919 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1920 #endif
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 #endif
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 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	1925
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1926
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1927 // 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	1928 // 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	1929 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	1930 }
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 /*************************************************************/
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1933 // 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	1934 // IN IDLE MODE .....
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1935 /*************************************************************/
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1936
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1937 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	1938 {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1939 BOOL decision = FALSE;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1940
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1941 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	1942 decision = l1s_gauging_decision_with_NP();
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1943 #if L1_GPRS
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1944 else
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1945 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	1946 decision = l1s_gauging_decision_with_PNP();
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 (decision == TRUE)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1950 {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1951 // gauging duration
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1952 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	1953
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1954 #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	1955 // 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	1956 #if (CODE_VERSION != SIMULATION)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1957 ULDP_GAUGING_START;
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1958 #if (CHIPSET == 12) \|\| (CHIPSET == 15)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1959 // Force the DPLL to be active
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1960 ( * (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	1961 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1962 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1963
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1964 #if (TRACE_TYPE != 0)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1965 #if (GSM_IDLE_RAM != 0)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1966 l1_trace_gauging_intram();
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1967 #else
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1968 l1_trace_gauging();
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1969 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1970 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1971 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1972
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1973 // DSP programmation .......
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1974 #if (DSP >= 33)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1975 #if (CHIPSET==4)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1976 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	1977 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1978 #else
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1979 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	1980 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1981
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1982 l1s.pw_mgr.gauging_task = ACTIVE;
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 }
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 }
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1987 /-------------------------------------------------------/
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1988 /* l1s_gauging_task_end() */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1989 /-------------------------------------------------------/
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1990 /* */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1991 /* Description: */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1992 /* ------------ */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1993 /* stop the gauging activity */
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1994 /-------------------------------------------------------/
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1995 void l1s_gauging_task_end(void)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1996 {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1997 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	1998 {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1999 /*************************************************************/
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2000 if (l1s.pw_mgr.gauging_task == ACTIVE)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2001 {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2002 /*************************************************************/
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2003 // 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	2004 /*************************************************************/
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2005 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	2006 {
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2007 // wait for end of gauging interrupt ...
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2008 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	2009
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2010 // Unmask ULPD GAUGING int.
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2011 #if (CODE_VERSION != SIMULATION)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2012 #if (CHIPSET == 12) \|\| (CHIPSET == 15)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2013 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	2014 #else
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2015 INTH_ENABLEONEIT(IQ_ULPD_GAUGING);
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2016 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2017 ULDP_GAUGING_STOP; // stop ULPD gauging
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2018 #if (CHIPSET == 12) \|\| (CHIPSET == 15)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2019 // 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	2020 //( * (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	2021 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2022 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2023
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2024 // DSP programmation : free IDLE modes...
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2025 #if (DSP >= 33)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2026 #if (CHIPSET==4)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2027 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	2028 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2029 #else
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2030 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	2031 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2032
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 #if (CODE_VERSION == SIMULATION)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2035 // 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	2036 GAUGING_Handler();
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2037
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2038 #if (TRACE_TYPE==5)
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2039 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	2040 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2041 #endif
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2042 }
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2043 }
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2044 }
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2045 }
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2046
50a15a54801e src/cs/layer1: import from tcs211-l1-reconst project Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2047 //#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	2048 #endif

FreeCalypso > hg > fc-magnetite

annotate src/cs/layer1/cfile/l1_pwmgr.c @ 547:c3f2f79dc5b8