view src/g23m-fad/udp/udp_pei.c @ 183:219afcfc6250

src/g23m-gprs: initial import from TCS3.2/LoCosto
author Mychaela Falconia <falcon@freecalypso.org>
date Thu, 13 Oct 2016 04:24:13 +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_ */

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