diff g23m/condat/ms/src/alr/alr_pch.c @ 0:509db1a7b7b8

initial import: leo2moko-r1
author Space Falcon <falcon@ivan.Harhan.ORG>
date Mon, 01 Jun 2015 03:24:05 +0000
parents
children
line wrap: on
line diff
--- /dev/null	Thu Jan 01 00:00:00 1970 +0000
+++ b/g23m/condat/ms/src/alr/alr_pch.c	Mon Jun 01 03:24:05 2015 +0000
@@ -0,0 +1,1159 @@
+/*
++-----------------------------------------------------------------------------
+|  Project :  GSM-PS
+|  Modul   :  ALR_PCH
++-----------------------------------------------------------------------------
+|  Copyright 2002 Texas Instruments Berlin, AG
+|                 All rights reserved.
+|
+|                 This file is confidential and a trade secret of Texas
+|                 Instruments Berlin, AG
+|                 The receipt of or possession of this file does not convey
+|                 any rights to reproduce or disclose its contents or to
+|                 manufacture, use, or sell anything it may describe, in
+|                 whole, or in part, without the specific written consent of
+|                 Texas Instruments Berlin, AG.
++-----------------------------------------------------------------------------
+|  Purpose :  This Modul defines the SDL process PCH_Control.
++-----------------------------------------------------------------------------
+*/
+
+#ifndef ALR_PCH_C
+#define ALR_PCH_C
+
+#define ENTITY_PL
+
+/*==== INCLUDES ===================================================*/
+#include <string.h>
+#include <stdlib.h>
+#include <ctype.h>
+#include "typedefs.h"
+#include "pconst.cdg"
+#include "mconst.cdg"
+#include "message.h"
+#include "ccdapi.h"
+#include "vsi.h"
+#include "custom.h"
+#include "gsm.h"
+#include "prim.h"
+#include "cnf_alr.h"
+#include "mon_alr.h"
+#include "pei.h"
+#include "tok.h"
+#include "pcm.h"
+#ifdef GPRS
+#include "alr_gprs.h"
+#endif
+
+#include "alr.h"
+#include "alr_em.h"
+
+/*==== EXPORT =====================================================*/
+/*==== PRIVAT =====================================================*/
+
+/*==== VARIABLES ==================================================*/
+UBYTE page_mode_before_hplmn_search = PGM_NORMAL;
+/*==== CONSTANTS ==================================================*/
+#define IMSI_ODD_FLAG     8
+#define IMSI_EVEN_FLAG    0
+#define IDENT_TYPE_MON    0
+#define IDENT_TYPE_IMSI   1
+#define IDENT_TYPE_IMEI   2
+#define IDENT_TYPE_IMEISV 3
+#define IDENT_TYPE_TMSI   4
+#define END_MARK          0xF0
+
+/*==== FUNCTIONS ==================================================*/
+
+#define TRACING
+
+#if defined (TRACING)
+#define ALR_TRACE_PCH(a)  ALR_TRACE(a)
+#else
+#define ALR_TRACE_PCH(a)
+#endif
+
+#ifdef TRACING
+#define ALR_TRACE_PCH_CONFIG(b,a,c,t,p,m)  \
+          TRACE_EVENT_P6 ("MFRMS: %d AG_RES: %d COMB: %d GRP: %d PGRP: %d PI: %d",b,a,c,t,p,m)
+#define ALR_TRACE_PCH_PGM(p,x) \
+          TRACE_EVENT_P2 ("new_pgm: %d cur_pgm: %d",p,x)
+#define ALR_TRACE_PCH_IMSI() \
+        { for (i=0; i<alr_data->pch_data.imsi[0]+1;i++) { \
+          TRACE_EVENT_P2 ("imsi[%d]=%x",i,alr_data->pch_data.imsi[i]);} }
+#else
+#define ALR_TRACE_PCH_CONFIG(b,a,c,t,p,m)
+#define ALR_TRACE_PCH_PGM(p,x)
+#define ALR_TRACE_PCH_IMSI()
+#endif
+
+/*
++--------------------------------------------------------------------+
+| PROJECT : GSM-PS (6103)       MODULE  : ALR_PCH                    |
+| STATE   : code                ROUTINE : pch_init                   |
++--------------------------------------------------------------------+
+
+  PURPOSE : Initialize PCH Control Process.
+
+*/
+GLOBAL void pch_init (void)
+{
+  alr_data->pch_data.saved_page_mode = PGM_REORG;
+  alr_data->pch_data.reorg_bcch_reading = FALSE;
+}
+
+/*
++--------------------------------------------------------------------+
+| PROJECT : GSM-PS (6103)       MODULE  : ALR_PCH                    |
+| STATE   : code                ROUTINE : pch_start                  |
++--------------------------------------------------------------------+
+
+  PURPOSE : Process signal pch_start from SDL process
+            Main_Control.
+
+*/
+static const UBYTE PAG_BLOCK_TABLE [2][8] =
+{
+  /* not combined ccch */
+  9,8,7,6,5,4,3,2,
+  /* combined ccch     */
+  3,2,1,1,1,1,1,1
+};
+
+/*
++--------------------------------------------------------------------+
+| PROJECT : GSM-PS (6103)       MODULE  : ALR_PCH                    |
+| STATE   : code                ROUTINE : pch_configure              |
++--------------------------------------------------------------------+
+
+  PURPOSE : Configutes L1 for paging.
+
+*/
+GLOBAL void pch_configure (T_MPH_IDLE_REQ *idle, UBYTE page_mode)
+{
+  UBYTE pag_blocks_per_mfr;
+
+  if(idle NEQ NULL)
+  {
+
+    alr_data->pch_data.dlt                      = idle->dlt;
+    alr_data->pch_data.act_dlt                  = idle->dlt;
+
+    ALR_EM_SET_EM_ACT_DLT;
+
+    pag_blocks_per_mfr                          = PAG_BLOCK_TABLE [idle->comb_ccch][idle->bs_ag_blocks_res];
+    /*
+     * pl_idle.bs_pa_mfrms has a range from 2-9.
+     * MPH_IDLE_REQ codes them from 0-7
+     */
+    alr_data->pch_data.pl_idle.bs_pa_mfrms      = (UBYTE)(idle->bs_pa_mfrms + 2);
+    alr_data->pch_data.pl_idle.bs_ag_blks_res   = idle->bs_ag_blocks_res;
+    alr_data->pch_data.pl_idle.bcch_combined    = idle->comb_ccch;
+    alr_data->pch_data.pl_idle.ccch_group       = (UBYTE)(idle->tn / 2);
+    alr_data->pch_data.pl_idle.page_group       = idle->pg;
+    alr_data->pch_data.pl_idle.page_block_index = (UBYTE)(idle->pg % pag_blocks_per_mfr);
+
+    ALR_TRACE_PCH_CONFIG(idle->bs_pa_mfrms+2, idle->bs_ag_blocks_res,
+                         idle->comb_ccch, idle->tn/2, idle->pg,
+                         idle->pg % pag_blocks_per_mfr);
+  }
+
+  /*
+   * During cell reselection reading of PCH is started hard coded with
+   * page mode PGM_REORG because of the lack of parameters to calculate
+   * the right paging group. Detection of SI3 during cell reselection
+   * triggers the function pch_config_resel() to reconfigure PCH reading,
+   * detection of a changed page mode during cell reselection is handled
+   * by function pch_check_page_mode_cr() which needs to know whether SI3
+   * is read
+   */
+  if (GET_STATE (STATE_MA) EQ MA_CELL_RESELECTION)
+    alr_data->pch_data.si3_read = FALSE;
+
+
+  /* Ensure that L1 does not get initialised with PAGING EXTENDED */
+  switch( page_mode )
+  {
+    case SAVED_PGM:
+      if( alr_data->pch_data.saved_page_mode EQ PGM_EXTENDED )
+      {
+        alr_data->pch_data.saved_page_mode = PGM_REORG;
+      }
+      page_mode = alr_data->pch_data.saved_page_mode;
+      /*lint -fallthrough*/
+    default:
+      alr_data->pch_data.pl_idle.page_mode = page_mode;
+  }
+}
+
+/*
++--------------------------------------------------------------------+
+| PROJECT : GSM-PS (6103)       MODULE  : ALR_PCH                    |
+| STATE   : code                ROUTINE : pch_save_pgm               |
++--------------------------------------------------------------------+
+  PURPOSE : Configure Paging
+*/
+GLOBAL void pch_save_pgm(UBYTE mode)
+{
+  if(mode)
+    alr_data->pch_data.saved_page_mode = mode;
+  else
+    alr_data->pch_data.saved_page_mode = alr_data->pch_data.pl_idle.page_mode;
+}
+
+
+/*
++--------------------------------------------------------------------+
+| PROJECT : GSM-PS (6103)       MODULE  : ALR_PCH                    |
+| STATE   : code                ROUTINE : pch_start_ccch_req         |
++--------------------------------------------------------------------+
+
+  PURPOSE : Configure Paging
+
+*/
+
+GLOBAL void pch_start_ccch_req (void)
+{
+  PALLOC(pl_idle, MPHC_START_CCCH_REQ);
+  memset(pl_idle, 0, sizeof(T_MPHC_START_CCCH_REQ));
+
+  ALR_EM_PAGE_MODE_CHANGE;
+
+  switch (alr_data->pch_data.pl_idle.page_mode)
+  {
+    case PGM_REORG:
+      ALR_TRACE_PCH ("config REORG");
+      /* dummy values */
+      pl_idle->bs_pa_mfrms      = 2;
+      pl_idle->bs_ag_blks_res   = 7;
+      pl_idle->bcch_combined    = 0;
+      pl_idle->ccch_group       = 0;
+      pl_idle->page_group       = 0;
+      pl_idle->page_block_index = 0;
+      pl_idle->page_mode        = PGM_REORG;
+      break;
+    case PGM_REORG_CS:
+      ALR_TRACE_PCH ("config REORG_CS");
+
+      memcpy (pl_idle, &alr_data->pch_data.pl_idle,
+              sizeof (T_MPHC_START_CCCH_REQ));
+      /*
+       * if the page_mode is PGM_REORG_CS then
+       * we have to change this to PGM_REORG
+       * before we send it to L1
+       */
+      pl_idle->page_mode        = PGM_REORG;
+     break;
+    case PGM_EXTENDED:
+      ALR_TRACE_PCH ("config EXT");
+
+      memcpy (pl_idle, &alr_data->pch_data.pl_idle,
+              sizeof (T_MPHC_START_CCCH_REQ));
+      pl_idle->page_mode        = PGM_EXTENDED;
+      break;
+   case PGM_REORG_NC_SYNC:
+     /*this case is the same as the default - except for the TRACE*/
+      ALR_TRACE_PCH ("config PGM_REORG_NC_SYNC (NORMAL)");
+
+      memcpy (pl_idle, &alr_data->pch_data.pl_idle,
+              sizeof (T_MPHC_START_CCCH_REQ));
+      pl_idle->page_mode        = PGM_NORMAL;
+     break;
+   default:
+      ALR_TRACE_PCH ("config NORMAL");
+
+      memcpy (pl_idle, &alr_data->pch_data.pl_idle,
+              sizeof (T_MPHC_START_CCCH_REQ));
+      pl_idle->page_mode        = PGM_NORMAL;
+     break;
+  }
+
+  SET_STATE(STATE_PCH,PCH_ACTIVE);
+  ma_pch_start_ccch_req(pl_idle);
+
+  TRACE_EVENT_P1("reorg_bcch_reading = %d",alr_data->pch_data.reorg_bcch_reading);
+  if(alr_data->pch_data.pl_idle.page_mode EQ PGM_REORG OR
+     alr_data->pch_data.pl_idle.page_mode EQ PGM_REORG_CS OR
+     alr_data->pch_data.reorg_bcch_reading EQ TRUE)
+  { /*
+     * if we're going into reorg paging we also need to read the BCCH
+     * to read possibly changed channel configuration
+     * XXX but not at PGM_REORG_NC_SYNC (NORMAL)
+     */
+    ma_scell_full_nbcch();
+  }
+  else
+  { /*
+     * otherwise we stop the reading of the BCCH and start the periodic read.
+     * XXX but not if we have a PBCCH
+     */
+#ifdef GPRS
+    if(alr_data->gprs_data.pbcch EQ FALSE)
+#endif
+      sc_start_periodic();
+  }
+}
+
+
+
+
+/*
++--------------------------------------------------------------------+
+| PROJECT : GSM-PS (6103)       MODULE  : ALR_PCH                    |
+| STATE   : code                ROUTINE : pch_identity_req           |
++--------------------------------------------------------------------+
+
+  PURPOSE : Get new mobile identity information from RR. Build IMSI
+            pattern and store TMSI.
+
+*/
+GLOBAL void pch_identity_req (T_MPH_IDENTITY_REQ *mph_identity_req)
+{
+  UBYTE i;
+
+  /* the IMSI in the identity request is coded as a 15byte long array
+     and is stored for later usage in pch_data as the message representation
+     of the IMSI according to GSM4.08 10.5.1.4 */
+
+  if (mph_identity_req->mid.len_imsi EQ 0)
+  {
+    /*
+     * limited service, no paging
+     */
+    memset (alr_data->pch_data.imsi, 0, IMSI_LEN);
+    alr_data->pch_data.v_tmsi   = FALSE;
+    alr_data->pch_data.tmsi     = 0L;
+  }
+  else
+  {
+    /*
+     * The IMSI is available
+     */
+    /* store length */
+    alr_data->pch_data.imsi[0] = (UBYTE)((mph_identity_req->mid.len_imsi + 2) / 2);
+
+    if (mph_identity_req->mid.len_imsi & 1)
+    {
+      ALR_TRACE_PCH ("IMSI is odd");
+      /*
+       * odd number of digits
+       * first digit + odd flag + identity type IMSI
+       */
+      alr_data->pch_data.imsi[1] = (UBYTE)((mph_identity_req->mid.imsi[0] << 4) +
+                                            IMSI_ODD_FLAG +
+                                            IDENT_TYPE_IMSI);
+    }
+    else
+    {
+      ALR_TRACE_PCH ("IMSI is even");
+      /*
+       * even number of digits
+       * first digit + even flag + identity type IMSI
+       */
+      alr_data->pch_data.imsi[1] = (UBYTE)((mph_identity_req->mid.imsi[0] << 4) +
+                                            IMSI_EVEN_FLAG +
+                                            IDENT_TYPE_IMSI);
+    }
+    /*
+     * fill in the rest of digits
+     */
+    for (i=1;i<mph_identity_req->mid.len_imsi;i++)
+    {
+      if (i & 1)
+        alr_data->pch_data.imsi[(i/2)+2] = (UBYTE)(END_MARK + mph_identity_req->mid.imsi[i]);
+      else
+      {
+        alr_data->pch_data.imsi[(i/2)+1] &= ~END_MARK;  /* remove end mark */
+        alr_data->pch_data.imsi[(i/2)+1] = (UBYTE)(alr_data->pch_data.imsi[(i/2)+1] +
+                                                   (mph_identity_req->mid.imsi[i] << 4));
+      }
+    }
+    alr_data->pch_data.imsi_mod_1000 = (SHORT)
+      ( (mph_identity_req->mid.imsi[mph_identity_req->mid.len_imsi-1] +
+         mph_identity_req->mid.imsi[mph_identity_req->mid.len_imsi-2] * 10 +
+         mph_identity_req->mid.imsi[mph_identity_req->mid.len_imsi-3] * 100 ) % 1000);
+
+    ALR_TRACE_PCH_IMSI();
+
+    /*
+     * copy TMSI
+     */
+    alr_data->pch_data.v_tmsi = mph_identity_req->mid.v_tmsi;
+    alr_data->pch_data.tmsi   = mph_identity_req->mid.tmsi;
+#ifdef GPRS
+    gprs_alr_store_ptmsi(mph_identity_req->mid.v_ptmsi,
+                         mph_identity_req->mid.ptmsi);
+    gprs_alr_store_ptmsi2(mph_identity_req->mid.v_ptmsi2,
+                          mph_identity_req->mid.ptmsi2);
+#endif
+  }
+}
+
+/*
++--------------------------------------------------------------------+
+| PROJECT : GSM-PS (6103)       MODULE  : ALR_PCH                    |
+| STATE   : code                ROUTINE : pch_increment_dlt          |
++--------------------------------------------------------------------+
+
+  PURPOSE : Incrementation of downlink timeout counter after receiving
+            a valid PCH block.
+
+*/
+GLOBAL void pch_increment_dlt (void)
+{
+  if (alr_data->pch_data.act_dlt <
+      alr_data->pch_data.dlt)
+  {
+#if !defined NTRACE
+    trc_mon_counter_idle (alr_data->pch_data.act_dlt,
+                          alr_data->pch_data.dlt);
+#endif /* (!defined NTRACE) */
+    alr_data->pch_data.act_dlt++;
+
+    ALR_EM_SET_EM_ACT_DLT;
+
+  }
+}
+
+/*
++--------------------------------------------------------------------+
+| PROJECT : GSM-PS (6103)       MODULE  : ALR_PCH                    |
+| STATE   : code                ROUTINE : pch_decrement_dlt          |
++--------------------------------------------------------------------+
+
+  PURPOSE : Decrementation of downlink timeout counter after receiving
+            an invalid PCH block.
+
+*/
+GLOBAL void pch_decrement_dlt (void)
+{
+  if (alr_data->pch_data.act_dlt > 4)
+  {
+#if !defined NTRACE
+    trc_mon_counter_idle (alr_data->pch_data.act_dlt,
+                          alr_data->pch_data.dlt);
+#endif /* (!defined NTRACE) */
+
+    alr_data->pch_data.act_dlt -= 4;
+
+    ALR_EM_SET_EM_ACT_DLT;
+
+  }
+  else
+  {
+    alr_data->pch_data.act_dlt = alr_data->pch_data.dlt;
+#if !defined NTRACE
+    trc_mon_counter_idle (alr_data->pch_data.act_dlt,
+                          alr_data->pch_data.dlt);
+#endif
+
+    ALR_EM_SET_EM_ACT_DLT;
+
+    ALR_TRACE_PCH ("downlink fail");
+
+    ma_error_ind (CS_DOWN_LINK_FAIL, alr_data->serving_cell);
+  }
+}
+
+
+/*
++--------------------------------------------------------------------+
+| PROJECT : GSM-PS (6103)       MODULE  : ALR_PCH                    |
+| STATE   : code                ROUTINE : pch_check_page_mode        |
++--------------------------------------------------------------------+
+
+  PURPOSE : Check the page mode of an incoming unacknowledged
+            message.
+*/
+static const UBYTE PAGE_MODE_CHANGE [3][4] =
+       {
+         /* old mode = paging normal         */
+         NONE,            SWAP_TO_EXTEND, SWAP_TO_REORG, NONE,
+         /* old mode = extended paging       */
+         SWAP_TO_NORMAL,  NONE,           SWAP_TO_REORG, NONE,
+         /* old mode = paging reorganisation */
+         SWAP_TO_NORMAL,  SWAP_TO_EXTEND, NONE,          NONE
+       };
+
+
+GLOBAL void pch_check_page_mode (T_MPHC_DATA_IND  *data_ind)
+{
+  UBYTE page_mode;
+  UBYTE cur_page_mode = alr_data->pch_data.pl_idle.page_mode;
+
+  page_mode = (UBYTE)(data_ind->l2_frame.content [3] & 3);
+
+  ALR_TRACE_PCH_PGM(page_mode, alr_data->pch_data.pl_idle.page_mode);
+
+  /*if HPLMN search is going on and we should be in REORG, we are really
+  in REORG_NC_SYNC (NORMAL). Otherwise we cannot synchronize to the NC's*/
+  if(alr_data->pch_data.pl_idle.page_mode EQ PGM_REORG_NC_SYNC)
+    cur_page_mode = PGM_REORG;
+
+  if(alr_data->pch_data.pl_idle.page_mode EQ PGM_REORG_CS)
+    cur_page_mode = PGM_REORG;
+
+  switch (PAGE_MODE_CHANGE [cur_page_mode][page_mode])
+  {
+    case SWAP_TO_NORMAL:
+      ALR_TRACE_PCH ("SWAP_TO_NORMAL");
+      alr_data->pch_data.pl_idle.page_mode = PGM_NORMAL;
+      pch_start_ccch_req ();
+      break;
+    case SWAP_TO_EXTEND:
+      ALR_TRACE_PCH ("SWAP_TO_EXT");
+      alr_data->pch_data.pl_idle.page_mode = PGM_EXTENDED;
+      pch_start_ccch_req ();
+      break;
+    case SWAP_TO_REORG:
+      ALR_TRACE_PCH ("SWAP_TO_REORG");
+      alr_data->pch_data.reorg_bcch_reading = TRUE;
+      alr_data->pch_data.si_bitmap = 0;
+      alr_data->pch_data.pl_idle.page_mode = PGM_REORG_CS;
+      pch_start_ccch_req ();
+      break;
+    default:
+      break;
+  }
+}
+
+GLOBAL void pch_check_page_mode_cr (T_MPHC_DATA_IND  *data_ind)
+{
+  UBYTE page_mode;
+  UBYTE cur_page_mode = alr_data->pch_data.saved_page_mode;
+  UBYTE swap = TRUE;
+
+  page_mode = (UBYTE)(data_ind->l2_frame.content [3] & 3);
+  if(alr_data->pch_data.saved_page_mode EQ PGM_REORG_CS)
+    cur_page_mode = PGM_REORG;
+
+  switch (PAGE_MODE_CHANGE [cur_page_mode][page_mode])
+  {
+    case SWAP_TO_NORMAL:
+      ALR_TRACE_PCH ("CR:SWAP_TO_NORMAL");
+      alr_data->pch_data.saved_page_mode = PGM_NORMAL;
+      break;
+
+    case SWAP_TO_EXTEND:
+      ALR_TRACE_PCH ("CR:SWAP_TO_EXT");
+      alr_data->pch_data.saved_page_mode = PGM_EXTENDED;
+      break;
+
+    case SWAP_TO_REORG:
+      ALR_TRACE_PCH ("CR:SWAP_TO_REORG");
+      alr_data->pch_data.saved_page_mode = PGM_REORG_CS;
+      break;
+
+    default:
+      swap = FALSE;
+      break;
+  }
+
+  if (swap AND alr_data->pch_data.si3_read AND
+      alr_data->pch_data.last_start_ccch_req.bs_pa_mfrms NEQ NOT_PRESENT_8BIT)
+  {
+    PALLOC(pl_idle, MPHC_START_CCCH_REQ);
+    memcpy ( pl_idle,
+             &(alr_data->pch_data.last_start_ccch_req),
+             sizeof(T_MPHC_START_CCCH_REQ));
+    pl_idle->page_mode = alr_data->pch_data.saved_page_mode;
+    ma_pch_start_ccch_req (pl_idle);
+  }
+
+}
+
+
+/*
++--------------------------------------------------------------------+
+| PROJECT : GSM-PS (6103)       MODULE  : ALR_PCH                    |
+| STATE   : code                ROUTINE : pch_check_pag_1            |
++--------------------------------------------------------------------+
+
+  PURPOSE : The function checks a paging request type 1 message.
+
+*/
+GLOBAL void pch_check_pag_1 (T_MPHC_DATA_IND *data_ind)
+{
+  UBYTE *frame  = data_ind->l2_frame.content;
+  ULONG  tmsi;
+  UBYTE  i;
+  UBYTE  channel_needed;
+  UBYTE *frame_start  = data_ind->l2_frame.content;
+  //ALR_TRACE_PCH ("p1");
+  /*
+   * Check only if IMSI available (len NEQ 0),
+   * ti and pd = 0x06 and
+   * l2 pseudolength is greater than 5 bytes
+   */
+  if (alr_data->pch_data.imsi[0] AND
+      frame[1] EQ 0x06 AND
+      frame[0] > 0x15)
+  {
+    /*
+     * store channel needed type
+     */
+    channel_needed = frame[3];
+    /*
+     * check type of identity for mobile identity 1
+     */
+    switch (frame [5] & 7)
+    {
+      case 1:
+        //ALR_TRACE_PCH ("p1 IMSI");
+        /*
+         * IMSI
+         */
+        if (!memcmp (alr_data->pch_data.imsi, &frame[4],
+                     alr_data->pch_data.imsi[0]+1))
+        {
+          //ALR_TRACE_PCH ("p1 IMSI match");
+          /*
+           * IMSI matches
+           */
+#ifdef GPRS
+          if(!gprs_alr_check_packet_paging(frame_start,1))
+#endif
+            ma_pch_paging_ind (1, (UBYTE)((channel_needed & 0x30)>>4));
+#ifdef GPRS
+          else if(GET_STATE(STATE_MA) NEQ MA_CON_EST)
+            ma_pch_paging_ind (ID_IMSI, CN_PACKET);
+#endif
+          return;
+        }
+        break;
+
+      case 4:
+        //ALR_TRACE_PCH ("p1 TMSI");
+        /*
+         * TMSI
+         */
+        if (alr_data->pch_data.v_tmsi)
+        {
+          tmsi = 0L;
+          for (i=0;i<frame[4]-1;i++)
+            tmsi += frame[i+6] << ((8*(frame[4]-2-i)));
+          if (alr_data->pch_data.tmsi EQ tmsi)
+          {
+            //ALR_TRACE_PCH ("p1 TMSI match");
+            /*
+             * TMSI matches
+             */
+            ma_pch_paging_ind (4, (UBYTE)((channel_needed & 0x30)>>4));
+            return;
+          }
+        }
+#ifdef GPRS
+        if(GET_STATE(STATE_MA) NEQ MA_CON_EST)
+        {
+          tmsi = 0L;
+          for (i=0;i<frame[4]-1;i++)
+            tmsi += frame[i+6] << ((8*(frame[4]-2-i)));
+          if(gprs_alr_check_ptmsi(tmsi)) return;
+        }
+#endif
+       break;
+    }
+    /*
+     * check type of identity for mobile identity 2
+     * set frame pointer to start of mobile identity 2 (id tag)
+     * old frame pointer (frame) +
+     * offset pseudo length etc (4) +
+     * length mobile identity 1 (frame [4]) +
+     * plus 1 byte for length field
+     */
+    frame = frame + 4 + frame[4] + 1;
+    if (frame[0] EQ 0x17)
+    {
+      /*
+       * mobile identity 2 is available
+       */
+      switch (frame [2] & 7)
+      {
+        case 1:
+          //ALR_TRACE_PCH ("p1 IMSI2");
+          /*
+           * IMSI
+           */
+          if (!memcmp (alr_data->pch_data.imsi, &frame[1],
+                       alr_data->pch_data.imsi[0]+1))
+          {
+            //ALR_TRACE_PCH ("p1 IMSI2 match");
+            /*
+             * IMSI matches
+             */
+#ifdef GPRS
+          if(! gprs_alr_check_packet_paging(frame_start,2))
+#endif
+            ma_pch_paging_ind (1, (UBYTE)((channel_needed & 0xC0)>>6));
+#ifdef GPRS
+          else if(GET_STATE(STATE_MA) NEQ MA_CON_EST)
+            ma_pch_paging_ind (ID_IMSI, CN_PACKET);
+#endif
+            return;
+          }
+          break;
+        case 4:
+          // ALR_TRACE_PCH ("p1 TMSI2");
+          /*
+           * TMSI
+           */
+          if (alr_data->pch_data.v_tmsi)
+          {
+            tmsi = 0L;
+            for (i=0;i<frame[1]-1;i++)
+              tmsi += frame[i+3] << ((8*(frame[1]-2-i)));
+            if (alr_data->pch_data.tmsi EQ tmsi)
+            {
+              ALR_TRACE_PCH ("p1 IMSI2");
+              /*
+               * TMSI matches
+               */
+              ma_pch_paging_ind (4, (UBYTE)((channel_needed & 0xC0)>>6));
+              return;
+            }
+          }
+#ifdef GPRS
+        if(GET_STATE(STATE_MA) NEQ MA_CON_EST)
+        {
+          tmsi = 0L;
+          for (i=0;i<frame[4]-1;i++)
+            tmsi += frame[i+6] << ((8*(frame[4]-2-i)));
+          if(gprs_alr_check_ptmsi(tmsi)) return;
+        }
+#endif
+          break;
+      }
+    }
+  }
+  //ALR_TRACE_PCH("end p1");
+}
+
+
+/*
++--------------------------------------------------------------------+
+| PROJECT : GSM-PS (6103)       MODULE  : ALR_PCH                    |
+| STATE   : code                ROUTINE : pch_check_pag_2            |
++--------------------------------------------------------------------+
+
+  PURPOSE : The function checks a paging request type 2 message.
+
+*/
+
+GLOBAL void pch_check_pag_2 (T_MPHC_DATA_IND *data_ind)
+{
+  UBYTE *frame  = data_ind->l2_frame.content;
+  ULONG  tmsi;
+  UBYTE  i;
+  UBYTE  channel_needed;
+
+  /*
+   * Check only if IMSI available (len NEQ 0) and
+   * ti and pd = 0x06 and
+   * l2 pseudolength is greater than 5 bytes
+   */
+  if (alr_data->pch_data.imsi[0] AND
+      frame[1] EQ 0x06 AND
+      frame[0] > 0x15)
+  {
+    /*
+     * store channel needed type
+     */
+    channel_needed = frame[3];
+    /*
+     * check mobile identity 1 only if TMSI is available
+     */
+    if (alr_data->pch_data.v_tmsi)
+    {
+      tmsi = 0L;
+      for (i=0;i<4;i++)
+        tmsi += frame[i+4] << (8*(3-i));
+      if (alr_data->pch_data.tmsi EQ tmsi)
+      {
+        /*
+         * TMSI matches
+         */
+        ma_pch_paging_ind (4, (UBYTE)((channel_needed & 0x30)>>4));
+        return;
+      }
+    }
+#ifdef GPRS
+    if(GET_STATE(STATE_MA) NEQ MA_CON_EST)
+    {
+      tmsi = 0L;
+      for (i=0;i<4;i++)
+        tmsi += frame[i+4] << (8*(3-i));
+      if(gprs_alr_check_ptmsi(tmsi)) return;
+    }
+#endif
+    /*
+     * check mobile identity 2 only if TMSI is available
+     */
+    if (alr_data->pch_data.v_tmsi)
+    {
+      tmsi = 0L;
+      for (i=0;i<4;i++)
+        tmsi += frame[i+8] << (8*(3-i));
+      if (alr_data->pch_data.tmsi EQ tmsi)
+      {
+        /*
+         * TMSI matches
+         */
+        ma_pch_paging_ind (4, (UBYTE)((channel_needed & 0xC0)>>6));
+        return;
+      }
+    }
+#ifdef GPRS
+    if(GET_STATE(STATE_MA) NEQ MA_CON_EST)
+    {
+      tmsi = 0L;
+      for (i=0;i<4;i++)
+        tmsi += frame[i+8] << (8*(3-i));
+      if(gprs_alr_check_ptmsi(tmsi)) return;
+    }
+#endif
+
+    if (frame[12] EQ 0x17)
+    {
+      /*
+       * mobile identity 3 is available
+       * calculation of channel needed for
+       * mobile identity 3 from the rest octet.
+       */
+      channel_needed = frame [ frame[13]+14 ];
+      if (channel_needed & 0x80)
+        channel_needed = (UBYTE)((channel_needed >> 5) & 3);
+      else
+        channel_needed = 0;
+
+      switch (frame [14] & 7)
+      {
+        case 1:
+          /*
+           * IMSI
+           */
+          if (!memcmp (alr_data->pch_data.imsi, &frame[13],
+                       alr_data->pch_data.imsi[0]+1))
+          {
+            /*
+             * IMSI matches
+             */
+#ifdef GPRS
+     if(! gprs_alr_check_packet_paging_2(frame,3))
+#endif
+       ma_pch_paging_ind (1, (UBYTE) channel_needed);
+#ifdef GPRS
+     else if(GET_STATE(STATE_MA) NEQ MA_CON_EST)
+       ma_pch_paging_ind (ID_IMSI, CN_PACKET);
+#endif
+            return;
+          }
+          break;
+        case 4:
+          /*
+           * TMSI
+           */
+          if (alr_data->pch_data.v_tmsi)
+          {
+            tmsi = 0L;
+            for (i=0;i<frame[13]-1;i++)
+              tmsi += frame[i+15] << ((8*(frame[13]-2-i)));
+            if (alr_data->pch_data.tmsi EQ tmsi)
+            {
+              /*
+               * TMSI matches
+               */
+              ma_pch_paging_ind (4, channel_needed);
+              return;
+            }
+#ifdef GPRS
+            if(GET_STATE(STATE_MA) NEQ MA_CON_EST)
+            {
+              tmsi = 0L;
+              for (i=0;i<frame[13]-1;i++)
+                tmsi += frame[i+15] << ((8*(frame[13]-2-i)));
+              if(gprs_alr_check_ptmsi(tmsi)) return;
+            }
+#endif
+          }
+          break;
+      }
+    }
+  }
+}
+
+/*
++--------------------------------------------------------------------+
+| PROJECT : GSM-PS (6103)       MODULE  : ALR_PCH                    |
+| STATE   : code                ROUTINE : pch_check_pag_3            |
++--------------------------------------------------------------------+
+
+  PURPOSE : The function checks a paging request type 3 message.
+
+*/
+
+GLOBAL void pch_check_pag_3 (T_MPHC_DATA_IND *data_ind)
+{
+  UBYTE *frame  = data_ind->l2_frame.content;
+  ULONG  tmsi;
+  UBYTE  i;
+  UBYTE  channel_needed;
+
+  /*
+   * Check only if IMSI available (len NEQ 0) and
+   * ti and pd = 0x06 and
+   * l2 pseudolength is greater than 5 bytes
+   */
+  if (alr_data->pch_data.imsi[0] AND
+      frame[1] EQ 0x06 AND
+      frame[0] > 0x15)
+  {
+    /*
+     * store channel needed type
+     */
+    channel_needed = frame[3];
+    /*
+     * check mobile identity 1 only if TMSI is available
+     */
+    if (alr_data->pch_data.v_tmsi)
+    {
+      tmsi = 0L;
+      for (i=0;i<4;i++)
+        tmsi += frame[i+4] << (8*(3-i));
+      if (alr_data->pch_data.tmsi EQ tmsi)
+      {
+        /*
+         * TMSI matches
+         */
+        ma_pch_paging_ind (4, (UBYTE)((channel_needed & 0x30)>>4));
+        return;
+      }
+    }
+#ifdef GPRS
+    if(GET_STATE(STATE_MA) NEQ MA_CON_EST)
+    {
+      tmsi = 0L;
+      for (i=0;i<4;i++)
+        tmsi += frame[i+4] << (8*(3-i));
+      if(gprs_alr_check_ptmsi(tmsi)) return;
+    }
+#endif
+
+    /*
+     * check mobile identity 2 only if TMSI is available
+     */
+    if (alr_data->pch_data.v_tmsi)
+    {
+      tmsi = 0L;
+      for (i=0;i<4;i++)
+        tmsi += frame[i+8] << (8*(3-i));
+      if (alr_data->pch_data.tmsi EQ tmsi)
+      {
+        /*
+         * TMSI matches
+         */
+        ma_pch_paging_ind (4, (UBYTE)((channel_needed & 0xC0)>>6));
+        return;
+      }
+    }
+#ifdef GPRS
+    if(GET_STATE(STATE_MA) NEQ MA_CON_EST)
+    {
+      tmsi = 0L;
+      for (i=0;i<4;i++)
+        tmsi += frame[i+8] << (8*(3-i));
+      if(gprs_alr_check_ptmsi(tmsi)) return;
+    }
+#endif
+    /*
+     * calculation of channel needed for
+     * mobile identity 3 and 4 from the rest octet.
+     */
+    channel_needed = frame [ 20 ];
+    if (channel_needed & 0x80)
+      channel_needed = (UBYTE)((channel_needed & 0x78) >> 3);
+    else
+      channel_needed = 0;
+    /*
+     * check mobile identity 3 only if TMSI is available
+     */
+    if (alr_data->pch_data.v_tmsi)
+    {
+      tmsi = 0L;
+      for (i=0;i<4;i++)
+        tmsi += frame[i+12] << (8*(3-i));
+      if (alr_data->pch_data.tmsi EQ tmsi)
+      {
+        /*
+         * TMSI matches
+         */
+        ma_pch_paging_ind (4, (UBYTE)(channel_needed >> 2));
+        return;
+      }
+#ifdef GPRS
+    if(GET_STATE(STATE_MA) NEQ MA_CON_EST)
+    {
+      tmsi = 0L;
+      for (i=0;i<4;i++)
+        tmsi += frame[i+12] << (8*(3-i));
+      if(gprs_alr_check_ptmsi(tmsi)) return;
+    }
+#endif
+    }
+    /*
+     * check mobile identity 4 only if TMSI is available
+     */
+    if (alr_data->pch_data.v_tmsi)
+    {
+      tmsi = 0L;
+      for (i=0;i<4;i++)
+        tmsi += frame[i+16] << (8*(3-i));
+      if (alr_data->pch_data.tmsi EQ tmsi)
+      {
+        /*
+         * TMSI matches
+         */
+        ma_pch_paging_ind (4, (UBYTE)(channel_needed & 3));
+        return;
+      }
+    }
+#ifdef GPRS
+    if(GET_STATE(STATE_MA) NEQ MA_CON_EST)
+    {
+      tmsi = 0L;
+      for (i=0;i<4;i++)
+        tmsi += frame[i+16] << (8*(3-i));
+      if(gprs_alr_check_ptmsi(tmsi)) return;
+    }
+#endif
+  }
+}
+
+/*
++--------------------------------------------------------------------+
+| PROJECT : GSM-PS (6103)       MODULE  : ALR_PCH                    |
+| STATE   : code                ROUTINE : pch_stop                   |
++--------------------------------------------------------------------+
+
+  PURPOSE : The function stops paging.
+
+*/
+GLOBAL void pch_stop(void)
+{
+  if(GET_STATE(STATE_PCH) EQ PCH_ACTIVE)
+  {
+    SET_STATE(STATE_PCH,PCH_NULL);
+    if(alr_data->pch_data.pl_idle.page_mode EQ PGM_REORG OR
+       alr_data->pch_data.pl_idle.page_mode EQ PGM_REORG_CS)
+    {
+      ALR_TRACE_PCH ("stop sc for pch");
+      ma_stop_scell_bcch_req();
+    }
+
+    ma_pch_stop();
+  }
+}
+
+/*used for S13 - to stop BCCH reading*/
+
+GLOBAL UBYTE pch_mode_reorg(void)
+{
+  if(alr_data->pch_data.pl_idle.page_mode EQ PGM_REORG OR
+     alr_data->pch_data.pl_idle.page_mode EQ PGM_REORG_CS OR
+     alr_data->pch_data.pl_idle.page_mode EQ PGM_REORG_NC_SYNC)
+    return TRUE;
+  else
+    return FALSE;
+}
+/*
++--------------------------------------------------------------------+
+| PROJECT : GSM-PS (6103)       MODULE  : ALR_PCH                    |
+| STATE   : code                ROUTINE : pch_no_of_paging_blocks    |
++--------------------------------------------------------------------+
+
+  PURPOSE : The function configures the paging reading during cell
+            reselection when reveived a SI3
+*/
+
+LOCAL SHORT pch_no_of_paging_blocks (UBYTE ccch_conf,
+                                     UBYTE bs_ag_blks_res,
+                                     UBYTE bs_pa_mfrms)
+{
+  /* in according to GSM 4.08 section 10.5.2.11, table 10.5.33 */
+  if (ccch_conf EQ COMB_CCCH_COMB)
+  {
+    /*
+     * combined CCCH,
+     *
+     * number of paging blocks = (3 - BS_AG_BLKS_RES) * BS_PA_MFRMS
+     *
+     * Maximum function only for security reasons, BCCH coding range is 0..7,
+     * but allowed is only 0..2.
+     */
+    return (( (1 >  (UBYTE)(3 - bs_ag_blks_res) ? 1 : (UBYTE)(3 - bs_ag_blks_res)) ) *
+            ((UBYTE)(2 + bs_pa_mfrms)));
+  }
+  else
+  {
+    /*
+     * non-combined CCCH,
+     *
+     * number of paging blocks = (9 - BS_AG_BLKS_RES) * BS_PA_MFRMS
+     */
+    return ((9 - bs_ag_blks_res) *
+            (2 + bs_pa_mfrms));
+  }
+}
+/*
++--------------------------------------------------------------------+
+| PROJECT : GSM-PS (6103)       MODULE  : ALR_PCH                    |
+| STATE   : code                ROUTINE : pch_config_resel           |
++--------------------------------------------------------------------+
+
+  PURPOSE : The function configures the L1 PCH reading during cell
+            reselection when reveived an SI3
+*/
+
+GLOBAL void pch_config_resel (T_MPHC_DATA_IND *data_ind)
+{
+  UBYTE *p_ctrl = &(data_ind->l2_frame.content[SI_CONTENTS_MSG_T+8]);
+  UBYTE ccch_conf,
+        bs_ag_blks_res,
+        bs_pa_mfrms,
+        pg,
+        pag_blocks_per_mfr;
+  SHORT n, b;
+  PALLOC(pl_idle, MPHC_START_CCCH_REQ);
+  memset(pl_idle, 0, sizeof(T_MPHC_START_CCCH_REQ));
+
+  bs_ag_blks_res = (UBYTE)(((*p_ctrl) & 0x38) >> 3);
+  ccch_conf      = (((*p_ctrl) & 0x07) EQ 0x01) ? COMB_CCCH_COMB : COMB_CCCH_NOT_COMB;
+  p_ctrl++;
+  bs_pa_mfrms    = (UBYTE)(((*p_ctrl) & 0x07));
+/*  TRACE_EVENT_P5("pch_config_resel IE: %02x %02x bs_ag_blks_res=%u ccch_conf=%u bs_pa_mfrms=%u",
+                  data_ind->l2_frame.content[SI_CONTENTS_MSG_T+8],
+                  *p_ctrl,
+                  bs_ag_blks_res,
+                  ccch_conf,
+                  bs_pa_mfrms);*/
+
+  n = pch_no_of_paging_blocks (ccch_conf, bs_ag_blks_res, bs_pa_mfrms);
+  b = ((ccch_conf / 2) + 1) * n;
+  pg = (UBYTE) ((alr_data->pch_data.imsi_mod_1000 % b) % n);
+  pag_blocks_per_mfr = PAG_BLOCK_TABLE [ccch_conf][bs_ag_blks_res];
+
+  pl_idle->bs_ag_blks_res   = bs_ag_blks_res;
+  pl_idle->bs_pa_mfrms      = (UBYTE)(bs_pa_mfrms + 2);
+  pl_idle->bcch_combined    = ccch_conf;
+  pl_idle->ccch_group       = (UBYTE) ((alr_data->pch_data.imsi_mod_1000 % b) / n);
+  pl_idle->page_group       = pg;
+  pl_idle->page_block_index = (UBYTE)(pg % pag_blocks_per_mfr);
+  pl_idle->page_mode        = (alr_data->pch_data.saved_page_mode EQ PGM_REORG_CS)
+                              ? PGM_REORG
+                              : alr_data->pch_data.saved_page_mode;
+
+/*  TRACE_EVENT_P3("n=%u b=%u page_mode=%u", n, b, pl_idle->page_mode);*/
+  ma_pch_start_ccch_req(pl_idle);
+
+  alr_data->pch_data.si3_read = TRUE;
+}
+#endif