view src/g23m-fad/udp/udp_pei.c @ 662:8cd8fd15a095

SIM speed enhancement re-enabled and made configurable TI's original code supported SIM speed enhancement, but Openmoko had it disabled, and OM's disabling of speed enhancement somehow caused certain SIM cards to start working which didn't work before (OM's bug #666). Because our FC community is much smaller in year 2020 than OM's community was in their day, we are not able to find one of those #666-affected SIMs, thus the real issue they had encountered remains elusive. Thus our solution is to re-enable SIM speed enhancement and simply wait for if and when someone runs into a #666-affected SIM once again. We provide a SIM_allow_speed_enhancement global variable that allows SIM speed enhancement to be enabled or disabled per session, and an /etc/SIM_spenh file in FFS that allows it to enabled or disabled on a non-volatile basis. SIM speed enhancement is now enabled by default.
author Mychaela Falconia <falcon@freecalypso.org>
date Sun, 24 May 2020 05:02:28 +0000
parents 90eb61ecd093
children
line wrap: on
line source

/*
+----------------------------------------------------------------------------
|  Project :  GSM-FaD (8411)
|  Modul   :  UDP_PEI
+----------------------------------------------------------------------------
|  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 process body interface
|             for the component Internet Protocol of the mobile station
+----------------------------------------------------------------------------
*/

#define ENTITY_UDP

/*==== INCLUDES ===================================================*/

#include <string.h>
#include <stdlib.h>
#include <stddef.h>
#include "typedefs.h"
#include "pcm.h"
#include "vsi.h"
#include "macdef.h"    /* to get PFREE_DESC2 */
#include "custom.h"
#include "gsm.h"
#include "message.h"
#include "ccdapi.h"
#include "prim.h"
#include "cus_udp.h"
#include "cnf_udp.h"
#include "mon_udp.h"
#include "pei.h"
#include "tok.h"
#include "dti.h"        /* to get dti lib */
#include "udp.h"

/*==== CONST ======================================================*/

/*==== VAR EXPORT =================================================*/

DTI_HANDLE udp_hDTI;
/* The DTI data base is being allocated in function dti_init(). */

T_HANDLE hCommACI = VSI_ERROR; /* ACI Communication */
T_HANDLE hCommLL = VSI_ERROR; /* LL Communication */
T_HANDLE hCommHL = VSI_ERROR; /* HL Communication */
T_HANDLE udp_handle;

T_UDP_DATA udp_data_base [UDP_INSTANCES], * udp_data;

/*==== VAR LOCAL ==================================================*/

static BOOL first_access = TRUE;
static T_MONITOR udp_mon;

/*==== FUNCTIONS ==================================================*/

/*
+--------------------------------------------------------------------+
| PROJECT : GSM-FaD (8411)             MODULE  : UDP_PEI             |
| STATE   : code                       ROUTINE : pei_not_supported   |
+--------------------------------------------------------------------+

  PURPOSE : An unsupported primitive is received.
*/

static void pei_not_supported (void * data)
{
  TRACE_FUNCTION ("pei_not_supported()");
  PFREE (data);
}

/* Use MAK_FUNC_0 for primitives which contains no SDU.
 * Use MAK_FUNC_S for primitives which contains a SDU. */

/* Jumptable for the UDPA service access point.
 * Contains the processing-function addresses and
 * opcodes of request and response primitives. */

static const T_FUNC udpa_table[] =
{
  MAK_FUNC_0 (ker_udpa_dti_req,    UDPA_DTI_REQ),
  MAK_FUNC_0 (ker_udpa_config_req, UDPA_CONFIG_REQ)
};

/* Jumptable for the UDP service access point.
 * Contains the processing-function addresses and
 * opcodes of request and response primitives. */

static const T_FUNC udp_table[] =
{
  MAK_FUNC_0 (ker_udp_bind_req,      UDP_BIND_REQ),
  MAK_FUNC_0 (ker_udp_closeport_req, UDP_CLOSEPORT_REQ),
  MAK_FUNC_0 (ker_udp_error_res,     UDP_ERROR_RES),
  MAK_FUNC_0 (ker_udp_shutdown_res,  UDP_SHUTDOWN_RES),
};

/* Jumptable for the IP service access point.
 * Contains the processing-function addresses and
 * opcodes of indication and confirm primitives. */

static const T_FUNC ip_table[] =
{
  MAK_FUNC_0 (ker_ip_addr_cnf, IP_ADDR_CNF),
};

/* Jumptable for the DTI service access point of the higher layer.
 * Contains the processing-function addresses and
 * opcodes of request and response primitives. */

static const T_FUNC dti_hl_table[] =
{
  MAK_FUNC_0 (pei_dti_dti_connect_req,    DTI2_CONNECT_REQ),
  MAK_FUNC_0 (pei_dti_dti_connect_res,    DTI2_CONNECT_RES),
  MAK_FUNC_0 (pei_dti_dti_disconnect_req, DTI2_DISCONNECT_REQ),
  MAK_FUNC_0 (pei_dti_dti_getdata_req,    DTI2_GETDATA_REQ),
  MAK_FUNC_0 (pei_dti_dti_data_req,       DTI2_DATA_REQ),
#ifdef _SIMULATION_
  MAK_FUNC_S (pei_dti_dti_data_test_req,  DTI2_DATA_TEST_REQ)
#endif
};

/* Jumptable for the DTI service access point of the lower layer.
 * Contains the processing-function addresses and
 * opcodes of indication and confirm primitives. */

static const T_FUNC dti_ll_table[] =
{
  MAK_FUNC_0 (pei_dti_dti_connect_ind,    DTI2_CONNECT_IND),
  MAK_FUNC_0 (pei_dti_dti_connect_cnf,    DTI2_CONNECT_CNF),
  MAK_FUNC_0 (pei_dti_dti_disconnect_ind, DTI2_DISCONNECT_IND),
  MAK_FUNC_0 (pei_dti_dti_ready_ind,      DTI2_READY_IND),
  MAK_FUNC_0 (pei_dti_dti_data_ind,       DTI2_DATA_IND),
#ifdef _SIMULATION_
  MAK_FUNC_S (pei_dti_dti_data_test_ind,  DTI2_DATA_TEST_IND)
#endif
};

/*
+--------------------------------------------------------------------+
| PROJECT : GSM-FaD (8411)               MODULE  : UDP_PEI           |
| STATE   : code                         ROUTINE : pei_primitive     |
+--------------------------------------------------------------------+

  PURPOSE : Process protocol specific primitive.
*/

static SHORT pei_primitive (void * ptr)
{
  /*
   * @ADAPT@
   *                    |
   *                   UL               HIGHER LAYER
   *                    |
   *                    v
   *      +-----------(udp)----------+
   *      |                          |
   *      |            UDP           |
   *      |                          |
   *      +-------------^------------+
   *                    |
   *                   DL               LOWER LAYER
   *                    |
   */

  /* Please note that the words "Downlink" and "Uplink"
   * should not be used here, because their meaning
   * is directly opposite to what is being meant here.
   * So let us correct the creator's mistake by
   * pronouncing "DL" as "Downlayer" and
   * "UL" as "Uplayer" and all should fit well
   * -- as long as you can remember this ... */

  TRACE_FUNCTION ("pei_primitive()");

  if (ptr != NULL)
  {
    T_PRIM * prim = ptr;
    ULONG opc = prim->custom.opc;
    USHORT n;
    const T_FUNC * table;

    VSI_PPM_REC (& prim->custom, __FILE__, __LINE__);

    PTRACE_IN (opc);

    udp_data = GET_INSTANCE (prim);

    switch (SAP_NR (opc))
    {
    case SAP_NR (UDP_UL):
      table = udp_table;
      n = TAB_SIZE (udp_table);
      break;
    case SAP_NR (UDPA_UL):
      table = udpa_table;
      n = TAB_SIZE (udpa_table);
      break;
    case IP_DL:
      table = ip_table;
      n = TAB_SIZE (ip_table);
      break;
    case DTI2_UL:
      table = dti_hl_table;
      n = TAB_SIZE (dti_hl_table);
      /*
      * to be able to distinguish DTI1/DTI2 opcodes,
      * the ones for DTI2 start at 0x50
      */
      opc -= 0x50;
      break;
    case DTI2_DL:
      table = dti_ll_table;
      n = TAB_SIZE (dti_ll_table);
      /*
      * to be able to distinguish DTI1/DTI2 opcodes,
      * the ones for DTI2 start at 0x50
      */
      opc -= 0x50;
      break;
    default:
      table = NULL;
      n = 0;
      break;
    }

    if (table NEQ NULL)
    {
      if (PRIM_NR (opc) < n)
      {
        table += PRIM_NR (opc);
#ifdef PALLOC_TRANSITION
        P_SDU(prim) = table->soff ?
          (T_sdu *) ((char *) & prim->data + table->soff) :
          0;
  #ifndef NO_COPY_ROUTING
        P_LEN(prim) = table->size + sizeof (T_PRIM_HEADER);
  #endif
#endif
        JUMP (table->func) (P2D (prim));
      }
      else
      {
        pei_not_supported (P2D (prim));
      }
      return PEI_OK;
    }

    /* Primitive is no GSM primitive
     * then forward to the environment */

#ifdef GSM_ONLY
    PFREE (P2D (prim));
    return PEI_ERROR;
#else
    if (opc & SYS_MASK)
      vsi_c_primitive (VSI_CALLER prim);
    else
    {
      PFREE (P2D (prim));
      return PEI_ERROR;
    }
#endif
  }
  return PEI_OK;
}

/*
+--------------------------------------------------------------------+
| PROJECT : GSM-PS (6147)              MODULE  : IP_PEI              |
| STATE   : code                       ROUTINE : pei_init            |
+--------------------------------------------------------------------+

  PURPOSE : Initialize Protocol Stack Entity
*/

static SHORT pei_init (T_HANDLE handle)
{
  udp_handle = handle;

  TRACE_FUNCTION ("pei_init()");

  udp_data = udp_data_base + UDP_SINGLE_LAYER;

  INIT_STATE (KER, DEACTIVATED);
  INIT_STATE (HILA, DOWN);
  INIT_STATE (LOLA, DOWN);

  if ((udp_hDTI = dti_init (
    2 * UDP_INSTANCES,
    udp_handle,
    DTI_DEFAULT_OPTIONS,
    pei_sig_callback
  )) EQ D_NO_DATA_BASE)
    return PEI_ERROR;

  /*
  if (hCommHL < VSI_OK)
    if ((hCommHL = vsi_c_open (VSI_CALLER WAP_NAME)) < VSI_OK)
      return PEI_ERROR;
  */
  if (hCommLL < VSI_OK)
    if ((hCommLL = vsi_c_open (VSI_CALLER IP_NAME)) < VSI_OK)
      return PEI_ERROR;

  if (hCommACI < VSI_OK)
    if ((hCommACI = vsi_c_open (VSI_CALLER ACI_NAME)) < VSI_OK)
      return PEI_ERROR;

  /* Init global parameters */
  init_udp ();

  return PEI_OK;
}

/*
+--------------------------------------------------------------------+
| PROJECT : GSM-FaD (8411)             MODULE  : UDP_PEI             |
| STATE   : code                       ROUTINE : pei_exit            |
+--------------------------------------------------------------------+

  PURPOSE : Close Resources and terminate
*/

static SHORT pei_exit (void)
{
  TRACE_FUNCTION ("pei_exit()");

  /* Clean up communication */

  vsi_c_close (VSI_CALLER hCommHL);
  hCommHL = VSI_ERROR;

  vsi_c_close (VSI_CALLER hCommLL);
  hCommLL = VSI_ERROR;

  vsi_c_close (VSI_CALLER hCommACI);
  hCommACI = VSI_ERROR;

  if (udp_hDTI NEQ D_NO_DATA_BASE)
    dti_deinit (udp_hDTI);

  return PEI_OK;
}

/*
+--------------------------------------------------------------------+
| PROJECT : GSM-FaD (8411)             MODULE  : UDP_PEI             |
| STATE   : code                       ROUTINE : pei_config          |
+--------------------------------------------------------------------+

  PURPOSE : Dynamic Configuration
*/

#ifndef NCONFIG
static KW_DATA kwtab[] = {
  {"", 0}
};
KW_DATA partab[] = {
  {"", 0}
};
#endif

static SHORT pei_config (T_PEI_CONFIG inString)
{
#ifndef NCONFIG
  char * s = inString;
  char * keyw;
  char * val[10];
  TRACE_FUNCTION ("pei_config()");
  TRACE_EVENT (s);

  tok_init (s);

  /* Parse next keyword and number of variables */
  while ((tok_next(&keyw,val)) NEQ TOK_EOCS)
  {
    switch ((tok_key ((KW_DATA *) kwtab, keyw)))
    {
    case TOK_NOT_FOUND:
      TRACE_ERROR ("[PEI_CONFIG]: Illegal Keyword");
      break;

    default:
      break;
    }
  }
#endif
  return PEI_OK;
}

/*
+--------------------------------------------------------------------+
| PROJECT : GSM-FaD (8411)             MODULE  : UDP_PEI             |
| STATE   : code                       ROUTINE : pei_monitor         |
+--------------------------------------------------------------------+

  PURPOSE : Monitoring of physical Parameters
*/

static SHORT pei_monitor (void ** monitor)
{
  TRACE_FUNCTION ("pei_monitor()");

  udp_mon.version = VERSION_UDP;
  *monitor = & udp_mon;
  return PEI_OK;
}

/*
+--------------------------------------------------------------------+
| PROJECT : GSM-FaD (8411)             MODULE  : UDP_PEI             |
| STATE   : code                       ROUTINE : pei_create          |
+--------------------------------------------------------------------+

  PURPOSE : Create the Protocol Stack Entity
*/

SHORT udp_pei_create (const T_PEI_INFO ** info)
{
  static const T_PEI_INFO pei_info =
  {
    "UDP",
    {
      pei_init,
      pei_exit,
      pei_primitive,
      NULL,             /* no timeout function */
      NULL,             /* no signal function */
      NULL,             /* no run function */
      pei_config,
      pei_monitor
    },
    1024,               /* stack size */
    10,                 /* queue entries */
    170,                /* priority */
    0,                  /* number of timers */
    0x03|PRIM_NO_SUSPEND/* flags */
  };

  TRACE_FUNCTION ("pei_create()");

  /* Close resources if open */
  if (first_access)
    first_access = FALSE;
  else
    pei_exit ();

  /* Export startup configuration data */
  *info = & pei_info;

  return PEI_OK;
}

/*
+----------------------------------------------------------------------------
|    Function: pei_sig_callback
+----------------------------------------------------------------------------
|    PURPOSE : Callback function for DTILIB
+----------------------------------------------------------------------------
*/

void pei_sig_callback (
  U8 instance,
  U8 interfac,
  U8 channel,
  U8 reason,
  T_DTI2_DATA_IND * dti_data_ind
) {
  TRACE_FUNCTION ("pei_sig_callback()");

#ifdef _SIMULATION_
  if (instance NEQ UDP_DTI_DEF_INSTANCE || channel NEQ UDP_DTI_DEF_CHANNEL)
  {
    TRACE_ERROR ("[PEI_SIG_CALLBACK] channel or instance not valid!");
    return; /* error, not found */
  }
#endif

  /* udp_data = udp_data_base + instance; */

  if (udp_hDTI NEQ D_NO_DATA_BASE)
  {
    switch (reason)
    {
      case DTI_REASON_CONNECTION_OPENED:
        switch (interfac)
        {
        case UDP_DTI_HL_INTERFACE:
          sig_dti_ker_connection_opened_hl_ind ();
          break;
        case UDP_DTI_LL_INTERFACE:
          sig_dti_ker_connection_opened_ll_ind ();
          break;
        default:
          TRACE_ERROR ("unknown DTILIB interface parameter");
          break;
        }
        break;

      case DTI_REASON_CONNECTION_CLOSED:
        switch (interfac)
        {
        case UDP_DTI_HL_INTERFACE:
          sig_dti_ker_connection_closed_hl_ind ();
          break;
        case UDP_DTI_LL_INTERFACE:
          sig_dti_ker_connection_closed_ll_ind ();
          break;
        default:
          TRACE_ERROR ("unknown DTILIB interface parameter");
          break;
        }
        break;

      case DTI_REASON_DATA_RECEIVED:
        switch (interfac)
        {
        case UDP_DTI_HL_INTERFACE:
          /*
           * DTI2_DATA_IND is interpreted as DTI2_DATA_REQ
           */
          PACCESS (dti_data_ind);
          {
          PPASS (dti_data_ind, dti_data_req, DTI2_DATA_REQ);
          sig_dti_ker_data_received_hl_ind (dti_data_req);
          }
          break;
        case UDP_DTI_LL_INTERFACE:
          sig_dti_ker_data_received_ll_ind (dti_data_ind);
          break;
        default:
          TRACE_ERROR ("unknown DTILIB interface parameter");
          break;
        }
        break;

      case DTI_REASON_TX_BUFFER_READY:
        switch (interfac)
        {
        case UDP_DTI_HL_INTERFACE:
          sig_dti_ker_tx_buffer_ready_hl_ind ();
          break;
        case UDP_DTI_LL_INTERFACE:
          sig_dti_ker_tx_buffer_ready_ll_ind ();
          break;
        default:
          TRACE_ERROR ("unknown DTILIB interface parameter");
          break;
        }
        break;

      case DTI_REASON_TX_BUFFER_FULL:
        switch (interfac)
        {
        case UDP_DTI_HL_INTERFACE:
          sig_dti_ker_tx_buffer_full_hl_ind (); /* DUMMY function */
          break;
        case UDP_DTI_LL_INTERFACE:
          sig_dti_ker_tx_buffer_full_ll_ind (); /* DUMMY function */
          break;
        default:
          TRACE_ERROR ("unknown DTILIB interface parameter");
          break;
        }
        break;

      default:
        TRACE_ERROR ("unknown DTILIB reason parameter");
        break;
    }
  }
  else
  {
    TRACE_ERROR ("Pointer to DTILIB database not existing");
  }
}

/*
+---------------------------------------------------------------------------+
| PROJECT: UDP                                            MODULE: udp_pei.c |
| STATE: code                              ROUTINE: pei_dti_dti_connect_req |
+---------------------------------------------------------------------------+

  PURPOSE: pei_dti_dti_connect_req wraps dti_dti_connect_req
*/

void pei_dti_dti_connect_req (T_DTI2_CONNECT_REQ * dti_connect_req)
{
  dti_dti_connect_req (udp_hDTI, dti_connect_req);
}

/*
+---------------------------------------------------------------------------+
| PROJECT: UDP                                            MODULE: udp_pei.c |
| STATE: code                           ROUTINE: pei_dti_dti_disconnect_ind |
+---------------------------------------------------------------------------+

  PURPOSE: pei_dti_dti_disconnect_ind wraps dti_dti_disconnect_ind
*/

void pei_dti_dti_disconnect_ind (T_DTI2_DISCONNECT_IND * dti_disconnect_ind)
{
  dti_dti_disconnect_ind (udp_hDTI, dti_disconnect_ind);
}

/*
+---------------------------------------------------------------------------+
| PROJECT: UDP                                            MODULE: udp_pei.c |
| STATE: code                              ROUTINE: pei_dti_dti_connect_cnf |
+---------------------------------------------------------------------------+

  PURPOSE: pei_dti_dti_connect_cnf wraps dti_dti_connect_cnf
*/

void pei_dti_dti_connect_cnf (T_DTI2_CONNECT_CNF * dti_connect_cnf)
{
  dti_dti_connect_cnf (udp_hDTI, dti_connect_cnf);
}

/*
+---------------------------------------------------------------------------+
| PROJECT: UDP                                            MODULE: udp_pei.c |
| STATE: code                              ROUTINE: pei_dti_dti_connect_ind |
+---------------------------------------------------------------------------+

  PURPOSE: pei_dti_dti_connect_ind wraps dti_dti_connect_ind
*/

void pei_dti_dti_connect_ind (T_DTI2_CONNECT_IND * dti_connect_ind)
{
  dti_dti_connect_ind (udp_hDTI, dti_connect_ind);
}

/*
+---------------------------------------------------------------------------+
| PROJECT: UDP                                            MODULE: udp_pei.c |
| STATE: code                              ROUTINE: pei_dti_dti_connect_res |
+---------------------------------------------------------------------------+

  PURPOSE: pei_dti_dti_connect_res wraps dti_dti_connect_res
*/

void pei_dti_dti_connect_res (T_DTI2_CONNECT_RES * dti_connect_res)
{
  dti_dti_connect_res (udp_hDTI, dti_connect_res);
}

/*
+---------------------------------------------------------------------------+
| PROJECT: UDP                                            MODULE: udp_pei.c |
| STATE: code                           ROUTINE: pei_dti_dti_disconnect_req |
+---------------------------------------------------------------------------+

  PURPOSE: pei_dti_dti_disconnect_req wraps dti_dti_disconnect_req
*/

void pei_dti_dti_disconnect_req (T_DTI2_DISCONNECT_REQ * dti_disconnect_req)
{
  dti_dti_disconnect_req (udp_hDTI, dti_disconnect_req);
}

/*
+---------------------------------------------------------------------------+
| PROJECT: UDP                                            MODULE: udp_pei.c |
| STATE: code                                 ROUTINE: pei_dti_dti_data_req |
+---------------------------------------------------------------------------+

  PURPOSE: pei_dti_dti_data_req wraps dti_dti_data_req
*/

void pei_dti_dti_data_req (T_DTI2_DATA_REQ * dti_data_req)
{
  dti_dti_data_req (udp_hDTI, dti_data_req);
}

/*
+---------------------------------------------------------------------------+
| PROJECT: UDP                                            MODULE: udp_pei.c |
| STATE: code                              ROUTINE: pei_dti_dti_getdata_req |
+---------------------------------------------------------------------------+

  PURPOSE: pei_dti_dti_getdata_req wraps dti_dti_getdata_req
*/

void pei_dti_dti_getdata_req (T_DTI2_GETDATA_REQ * dti_getdata_req)
{
  dti_dti_getdata_req (udp_hDTI, dti_getdata_req);
}

/*
+---------------------------------------------------------------------------+
| PROJECT: UDP                                            MODULE: udp_pei.c |
| STATE: code                                 ROUTINE: pei_dti_dti_data_ind |
+---------------------------------------------------------------------------+

  PURPOSE: pei_dti_dti_data_ind wraps dti_dti_data_ind
*/

void pei_dti_dti_data_ind (T_DTI2_DATA_IND * dti_data_ind)
{
  dti_dti_data_ind (udp_hDTI, dti_data_ind);
}

/*
+---------------------------------------------------------------------------+
| PROJECT: UDP                                            MODULE: udp_pei.c |
| STATE: code                                ROUTINE: pei_dti_dti_ready_ind |
+---------------------------------------------------------------------------+

  PURPOSE: pei_dti_dti_ready_ind wraps dti_dti_ready_ind
*/

void pei_dti_dti_ready_ind (T_DTI2_READY_IND * dti_ready_ind)
{
  dti_dti_ready_ind (udp_hDTI, dti_ready_ind);
}

#ifdef _SIMULATION_

/*
+---------------------------------------------------------------------------+
| PROJECT: UDP                                            MODULE: udp_pei.c |
| STATE: code                            ROUTINE: pei_dti_dti_data_test_req |
+---------------------------------------------------------------------------+

  PURPOSE: pei_dti_dti_data_test_req wraps dti_dti_data_test_req
*/

void pei_dti_dti_data_test_req (T_DTI2_DATA_TEST_REQ * dti_data_test_req)
{
  dti_dti_data_test_req (udp_hDTI, dti_data_test_req);
}

/*
+---------------------------------------------------------------------------+
| PROJECT: UDP                                            MODULE: udp_pei.c |
| STATE: code                            ROUTINE: pei_dti_dti_data_test_ind |
+---------------------------------------------------------------------------+

  PURPOSE: pei_dti_dti_data_test_ind wraps dti_dti_data_test_ind
*/

void pei_dti_dti_data_test_ind (T_DTI2_DATA_TEST_IND * dti_data_test_ind)
{
  dti_dti_data_test_ind (udp_hDTI, dti_data_test_ind);
}

#endif /* _SIMULATION_ */

/*-------------------------------------------------------------------------*/