view src/g23m-fad/fad/fad_sbm.c @ 165:2c82c413775f

gcc bootentry.S: SE J100 target support
author Mychaela Falconia <falcon@freecalypso.org>
date Sat, 06 Apr 2019 08:49:03 +0000
parents d393cd9bb723
children
line wrap: on
line source

/* 
+----------------------------------------------------------------------------- 
|  Project :  GSM-F&D (8411)
|  Modul   :  FAD_SBM
+----------------------------------------------------------------------------- 
|  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 send buffer manager for
|             the component Fax Adaptation 3.45 of the mobile station
+----------------------------------------------------------------------------- 
*/ 

#ifndef FAD_SBM_C
#define FAD_SBM_C
#endif

#define ENTITY_FAD

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

#include <string.h>
#include "typedefs.h"
#include "pconst.cdg"
#include "vsi.h"
#include "custom.h"
#include "gsm.h"
#include "cnf_fad.h"
#include "mon_fad.h"
#include "prim.h"
#include "pei.h"
#include "tok.h"
#include "ccdapi.h"
#include "cl_ribu.h"
#include "fad.h"

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

/*==== TYPES =======================================================*/

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

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

/*==== FUNCTIONS ===================================================*/
 
/*
+--------------------------------------------------------------------+
| PROJECT : GSM-F&D (8411)             MODULE  : FAD_SBM             |
| STATE   : code                       ROUTINE : sbm_init            |
+--------------------------------------------------------------------+

  PURPOSE : 

*/
GLOBAL void sbm_init(USHORT frameSize)
{
  T_SBM *sbm = &fad_data->sbm;
  USHORT n;

  TRACE_FUNCTION ("sbm_init()");

  cl_ribu_init(&sbm->ribu, SBM_PRIMBUF_SIZE);

  for (n = 0; n < sbm->ribu.depth; n++)
    sbm->Prim[n].Prim = NULL;

  sbm->PA = 0;
  sbm->CurrPrimOff = 0;
  sbm->CurrPrimLen = 0;
  sbm->FrameSize   = frameSize;

  fad_data->snd.FD.buf = fad_data->snd.FD_buf;
}

/*
+--------------------------------------------------------------------+
| PROJECT : GSM-F&D (8411)             MODULE  : FAD_SBM             |
| STATE   : code                       ROUTINE : sbm_store_prim      |
+--------------------------------------------------------------------+

  PURPOSE : 

*/

GLOBAL void sbm_store_prim(T_SBM_PRIM *sendPrim)
{
  T_SBM *sbm = &fad_data->sbm;

#ifdef _SIMULATION_
  TRACE_FUNCTION ("sbm_store_prim()");
#endif

  sbm->Prim[sbm->ribu.wi].Prim = sendPrim;

  if (!sbm->ribu.filled) /* Initialize new primitive for read out */
  {
    sbm->CurrPrimOff = sendPrim->sdu.o_buf >> 3;
    sbm->CurrPrimLen = sendPrim->sdu.l_buf >> 3;
  }
  cl_ribu_write_index(&sbm->ribu);
}

/*
+--------------------------------------------------------------------+
| PROJECT : GSM-F&D (8411)             MODULE  : FAD_SBM             |
| STATE   : code                       ROUTINE : sbm_free_empty_prims|
+--------------------------------------------------------------------+

  PURPOSE : 

*/

GLOBAL void sbm_free_empty_prims(void)
{
  T_SBM *sbm = &fad_data->sbm;

#ifdef _SIMULATION_
  TRACE_FUNCTION ("sbm_free_empty_prims()");
#endif
  
  while (sbm->PA NEQ sbm->ribu.ri)
  {
    PFREE (sbm->Prim[sbm->PA].Prim);
    sbm->PA++;
    if (sbm->PA EQ sbm->ribu.depth)
      sbm->PA = 0;
  }
}

/*
+--------------------------------------------------------------------+
| PROJECT : GSM-F&D (8411)             MODULE  : FAD_SBM             |
| STATE   : code                       ROUTINE : sbm_get_frame       |
+--------------------------------------------------------------------+

  PURPOSE : 

*/

GLOBAL BOOL sbm_get_frame(T_FRAME_DESC *ul_FD, UBYTE reqFrames)
{
  T_SBM *sbm = &fad_data->sbm;

  USHORT requiredData;
  BOOL   insertSync;

#ifdef _SIMULATION_
  TRACE_FUNCTION ("sbm_get_frame()");
#endif

  cl_set_frame_desc_0(ul_FD, NULL, 0);

  if (!sbm->ribu.filled) /* There is no primitive */
  {
    return FALSE;
  }

  insertSync = FALSE;

  if (sbm->syncCycle NEQ SYNC_CYCLE_NONE)
  {
    if (reqFrames > sbm->framesUntilSync)
    {
      insertSync = TRUE;
      reqFrames--;
    }
    else
      sbm->framesUntilSync -= reqFrames;
  }

  requiredData = sbm->FrameSize * (USHORT)reqFrames;

  if (sbm->CurrPrimLen > requiredData)
  {
    /* Current primitive holds more than enough data */
    cl_set_frame_desc_0(ul_FD, sbm->Prim[sbm->ribu.ri].Prim->sdu.buf + sbm->CurrPrimOff, requiredData);

    sbm->CurrPrimOff += requiredData;
    sbm->CurrPrimLen -= requiredData;
  }
  else
  {
    /* 
     * Current primitive doesn't hold enough data
     * or just the right amount of data.
     * -> Switch to next primitive
     */

    /* Take all data from first primitive */
    cl_set_frame_desc_0(ul_FD, sbm->Prim[sbm->ribu.ri].Prim->sdu.buf + sbm->CurrPrimOff, sbm->CurrPrimLen);

    cl_ribu_read_index(&sbm->ribu); /* Switch to next primitive */

    if (!sbm->ribu.filled)          /* There is no second primitive */
    {
      ul_FD->Adr[1] = (UBYTE *) NULL;
      ul_FD->Len[1] = 0;
      sbm->CurrPrimOff = 0;
      sbm->CurrPrimLen = 0;
    }
    else                            /* Second primitive is available */
    {
      requiredData -= sbm->CurrPrimLen;

      sbm->CurrPrimOff = sbm->Prim[sbm->ribu.ri].Prim->sdu.o_buf >> 3;
      sbm->CurrPrimLen = sbm->Prim[sbm->ribu.ri].Prim->sdu.l_buf >> 3;

      if (requiredData EQ 0)
      {
        /*
         * First primitive was just used up.
         * We had to switch to next primitive, but don't need data.
         */
        ul_FD->Adr[1] = (UBYTE *) NULL;
        ul_FD->Len[1] = 0;
      }
      else
      {
        /* Data from next primitive is required */
        ul_FD->Adr[1] = sbm->Prim[sbm->ribu.ri].Prim->sdu.buf + sbm->CurrPrimOff;

        if (sbm->CurrPrimLen > requiredData)
        {
          /* Enough data found in second primitive */
          ul_FD->Len[1] = requiredData;
          sbm->CurrPrimOff += requiredData;
          sbm->CurrPrimLen -= requiredData;
        }
        else
        {
          /* Even with the second primitive there are not enough data! */
          ul_FD->Len[1] = sbm->CurrPrimLen;

          /* Second primitive is also emptied, switch to next primitve */
          cl_ribu_read_index(&sbm->ribu);

          if (sbm->ribu.filled)
          {
            sbm->CurrPrimOff = sbm->Prim[sbm->ribu.ri].Prim->sdu.o_buf >> 3;
            sbm->CurrPrimLen = sbm->Prim[sbm->ribu.ri].Prim->sdu.l_buf >> 3;

          }
          else
          {
            sbm->CurrPrimOff = 0;
            sbm->CurrPrimLen = 0;
          }
        }
      }
    }
  }

  if ((ul_FD->Len[0]+ul_FD->Len[1]) < requiredData)
  {
    /*
     * If there are not enough data available align the length to 64 bit 
     * align the length to 64 bit boundaries.
     * This alignment should normally occur at the end of the message phase.
     * The required data are always a multiple of 64 bits.
     */
    int i, k = 0;
    int diff = requiredData - (ul_FD->Len[0]+ul_FD->Len[1]);

    if (ul_FD->Len[1] > 0)
      k = 1;

    for (i = 0; i < ul_FD->Len[k]; i++)
      fad_data->snd.ul_FD_align[i] = ul_FD->Adr[k][i];

    for (i = ul_FD->Len[k]; i < ul_FD->Len[k] + diff; i++)
      fad_data->snd.ul_FD_align[i] = 0;

    ul_FD->Len[k] += diff;
    ul_FD->Adr[k] = fad_data->snd.ul_FD_align;
  }

  if (insertSync)
  {
    USHORT framesUntilSync = sbm->framesUntilSync;
    USHORT frame_off = 0, i, j;

    for (i=0; i<2; i++)
    {
      for (j=0; j<ul_FD->Len[i]; j+=FRAME_SIZE)
      {
        if (framesUntilSync-- EQ 0)
        {
          memcpy((char*)&sbm->frames[frame_off], (char*)FR_SEQ_SYNC, FRAME_SIZE);
          frame_off+=FRAME_SIZE;
        }
        memcpy((char*)&sbm->frames[frame_off], (char*)ul_FD->Adr[i], FRAME_SIZE);
        frame_off+=FRAME_SIZE;

        sbm->framesUntilSync = sbm->syncCycle - reqFrames + framesUntilSync;
      }
    }
    cl_set_frame_desc_0(ul_FD, sbm->frames, (USHORT)((reqFrames+1)*FRAME_SIZE));
  }
  return TRUE;
}