source: CIVL/examples/experimental/reverse_CIVL/ADFirstAidKit/adStack.c@ beab7f2

static char adSid[]="$Id: adStack.c 5951 2016-02-09 12:22:02Z llh $";

#include <stdlib.h>
#include <stdio.h>
#include <string.h>

/* The size of a BLOCK in characters */
#define ONE_BLOCK_SIZE 16384
#ifndef STACK_SIZE_TRACING
#define STACK_SIZE_TRACING 1
#endif
/* The main stack is a double-chain of DoubleChainedBlock objects.
 * Each DoubleChainedBlock holds an array[ONE_BLOCK_SIZE] of char. */
typedef struct _doubleChainedBlock{
  struct _doubleChainedBlock *prev ;
  char                       *contents ;
  struct _doubleChainedBlock *next ;
} DoubleChainedBlock ;

/* Globals that define the current position in the stack: */
static DoubleChainedBlock *curStack = NULL ;
static char               *curStackTop = NULL ;
/* Globals that define the current LOOKing position in the stack: */
static DoubleChainedBlock *lookStack = NULL ;
static char               *lookStackTop = NULL ;

static long int mmctraffic = 0 ;
static long int mmctrafficM = 0 ;
#ifdef STACK_SIZE_TRACING
long int bigStackSize = 0;
#endif

/* PUSHes "nbChars" consecutive chars from a location starting at address "x".
 * Resets the LOOKing position if it was active.
 * Checks that there is enough space left to hold "nbChars" chars.
 * Otherwise, allocates the necessary space. */
void pushNarray(char *x, unsigned int nbChars) {
  unsigned int nbmax = (curStack)?ONE_BLOCK_SIZE-(curStackTop-(curStack->contents)):0 ;
#ifdef STACK_SIZE_TRACING
  bigStackSize += nbChars;
#endif

  mmctraffic += nbChars ;
  while (mmctraffic >= 1000000) {
     mmctraffic -= 1000000 ;
     mmctrafficM++ ;
  }

  lookStack = NULL ;
  if (nbChars <= nbmax) {
    memcpy(curStackTop,x,nbChars) ;
    curStackTop+=nbChars ;
  } else {
    char *inx = x+(nbChars-nbmax) ;
    if (nbmax>0) memcpy(curStackTop,inx,nbmax) ;
    while (inx>x) {
      if ((curStack == NULL) || (curStack->next == NULL)) {
        /* Create new block: */
        DoubleChainedBlock *newStack ;
        char *contents = (char *)malloc(ONE_BLOCK_SIZE*sizeof(char)) ;
        newStack = (DoubleChainedBlock*)malloc(sizeof(DoubleChainedBlock)) ;
        if ((contents == NULL) || (newStack == NULL)) {
          DoubleChainedBlock *stack = curStack ;
          int nbBlocks = (stack?-1:0) ;
          while(stack) {
              stack = stack->prev ;
              nbBlocks++ ;
          }
          printf("Out of memory (allocated %i blocks of %i bytes)\n",
                 nbBlocks, ONE_BLOCK_SIZE) ;
          exit(0);
        }
        if (curStack != NULL) curStack->next = newStack ;
        newStack->prev = curStack ;
        newStack->next = NULL ;
        newStack->contents = contents ;
        curStack = newStack ;
        /* new block created! */
      } else
        curStack = curStack->next ;
      inx -= ONE_BLOCK_SIZE ;
      if(inx>x)
        memcpy(curStack->contents,inx,ONE_BLOCK_SIZE) ;
      else {
        unsigned int nbhead = (inx-x)+ONE_BLOCK_SIZE ;
        curStackTop = curStack->contents ;
        memcpy(curStackTop,x,nbhead) ;
        curStackTop += nbhead ;
      }
    }
  }
}

/* POPs "nbChars" consecutive chars to a location starting at address "x".
 * Resets the LOOKing position if it was active.
 * Checks that there is enough data to fill "nbChars" chars.
 * Otherwise, pops as many blocks as necessary. */
void popNarray(char *x, unsigned int nbChars) {
  unsigned int nbmax = curStackTop-(curStack->contents) ;
#ifdef STACK_SIZE_TRACING
  bigStackSize -= nbChars;
#endif
  lookStack = NULL ;
  if (nbChars <= nbmax) {
    curStackTop-=nbChars ;
    memcpy(x,curStackTop,nbChars);
  } else {
    char *tlx = x+nbChars ;
    if (nbmax>0) memcpy(x,curStack->contents,nbmax) ;
    x+=nbmax ;
    while (x<tlx) {
      curStack = curStack->prev ;
      if (curStack==NULL) printf("Popping from an empty stack!!!\n") ;
      if (x+ONE_BLOCK_SIZE<tlx) {
        memcpy(x,curStack->contents,ONE_BLOCK_SIZE) ;
        x += ONE_BLOCK_SIZE ;
      } else {
        unsigned int nbtail = tlx-x ;
        curStackTop=(curStack->contents)+ONE_BLOCK_SIZE-nbtail ;
        memcpy(x,curStackTop,nbtail) ;
        x = tlx ;
      }
    }
  }
}

/* LOOKs "nbChars" consecutive chars to a location starting at address "x".
 * Activates the LOOKing position if it was reset.
 * LOOKing is just like POPping, except that the main pointer
 * remains in place, so that the value is not POPped.
 * Further PUSHs or POPs will start from the same place as if
 * no LOOK had been made. */
void lookNarray(char *x, unsigned int nbChars) {
  unsigned int nbmax ;
  if (lookStack == NULL) {
    lookStack = curStack ;
    lookStackTop = curStackTop ;
  }
  nbmax = lookStackTop-(lookStack->contents) ;
  if (nbChars <= nbmax) {
    lookStackTop-=nbChars ;
    memcpy(x,lookStackTop,nbChars);
  } else {
    char *tlx = x+nbChars ;
    if (nbmax>0) memcpy(x,lookStack->contents,nbmax) ;
    x+=nbmax ;
    while (x<tlx) {
      lookStack = lookStack->prev ;
      if (lookStack==NULL) printf("Looking into an empty stack!!!") ;
      if (x+ONE_BLOCK_SIZE<tlx) {
        memcpy(x,lookStack->contents,ONE_BLOCK_SIZE) ;
        x += ONE_BLOCK_SIZE ;
      } else {
        unsigned int nbtail = tlx-x ;
        lookStackTop=(lookStack->contents)+ONE_BLOCK_SIZE-nbtail ;
        memcpy(x,lookStackTop,nbtail) ;
        x = tlx ;
      }
    }
  }
}

void resetadlookstack_() {
  lookStack=NULL ;
}

/****** Exported PUSH/POP/LOOK functions for ARRAYS: ******/
/*   --> Called from FORTRAN:                             */

void pushcharacterarray_(char *x, unsigned int *n) {
  pushNarray(x,*n) ;
}
void popcharacterarray_(char *x, unsigned int *n) {
  popNarray(x,*n) ;
}
void lookcharacterarray_(char *x, unsigned int *n) {
  lookNarray(x,*n) ;
}

void pushbooleanarray_(char *x, unsigned int *n) {
  pushNarray(x,(*n*4)) ;
}
void popbooleanarray_(char *x, unsigned int *n) {
  popNarray(x,(*n*4)) ;
}
void lookbooleanarray_(char *x, unsigned int *n) {
  lookNarray(x,(*n*4)) ;
}

void pushinteger4array_(void *x, unsigned int *n) {
  pushNarray((char *)x,(*n*4)) ;
}
void popinteger4array_(void *x, unsigned int *n) {
  popNarray((char *)x,(*n*4)) ;
}
void lookinteger4array_(void *x, unsigned int *n) {
  lookNarray((char *)x,(*n*4)) ;
}

void pushinteger8array_(void *x, unsigned int *n) {
  pushNarray((char *)x,(*n*8)) ;
}
void popinteger8array_(void *x, unsigned int *n) {
  popNarray((char *)x,(*n*8)) ;
}
void lookinteger8array_(void *x, unsigned int *n) {
  lookNarray((char *)x,(*n*8)) ;
}

void pushinteger16array_(void *x, unsigned int *n) {
  pushNarray((char *)x,(*n*16)) ;
}
void popinteger16array_(void *x, unsigned int *n) {
  popNarray((char *)x,(*n*16)) ;
}
void lookinteger16array_(void *x, unsigned int *n) {
  lookNarray((char *)x,(*n*16)) ;
}

void pushreal4array_(void *x, unsigned int *n) {
  pushNarray((char *)x,(*n*4)) ;
}
void popreal4array_(void *x, unsigned int *n) {
  popNarray((char *)x,(*n*4)) ;
}
void lookreal4array_(void *x, unsigned int *n) {
  lookNarray((char *)x,(*n*4)) ;
}

void pushreal8array_(void *x, unsigned int *n) {
  pushNarray((char *)x,(*n*8)) ;
}
void popreal8array_(void *x, unsigned int *n) {
  popNarray((char *)x,(*n*8)) ;
}
void lookreal8array_(void *x, unsigned int *n) {
  lookNarray((char *)x,(*n*8)) ;
}

void pushreal16array_(void *x, unsigned int *n) {
  pushNarray((char *)x,(*n*16)) ;
}
void popreal16array_(void *x, unsigned int *n) {
  popNarray((char *)x,(*n*16)) ;
}
void lookreal16array_(void *x, unsigned int *n) {
  lookNarray((char *)x,(*n*16)) ;
}

void pushreal32array_(void *x, unsigned int *n) {
  pushNarray((char *)x,(*n*32)) ;
}
void popreal32array_(void *x, unsigned int *n) {
  popNarray((char *)x,(*n*32)) ;
}
void lookreal32array_(void *x, unsigned int *n) {
  lookNarray((char *)x,(*n*32)) ;
}

void pushcomplex4array_(void *x, unsigned int *n) {
  pushNarray((char *)x,(*n*4)) ;
}
void popcomplex4array_(void *x, unsigned int *n) {
  popNarray((char *)x,(*n*4)) ;
}
void lookcomplex4array_(void *x, unsigned int *n) {
  lookNarray((char *)x,(*n*4)) ;
}

void pushcomplex8array_(void *x, unsigned int *n) {
  pushNarray((char *)x,(*n*8)) ;
}
void popcomplex8array_(void *x, unsigned int *n) {
  popNarray((char *)x,(*n*8)) ;
}
void lookcomplex8array_(void *x, unsigned int *n) {
  lookNarray((char *)x,(*n*8)) ;
}

void pushcomplex16array_(void *x, unsigned int *n) {
  pushNarray((char *)x,(*n*16)) ;
}
void popcomplex16array_(void *x, unsigned int *n) {
  popNarray((char *)x,(*n*16)) ;
}
void lookcomplex16array_(void *x, unsigned int *n) {
  lookNarray((char *)x,(*n*16)) ;
}

void pushcomplex32array_(void *x, unsigned int *n) {
  pushNarray((char *)x,(*n*32)) ;
}
void popcomplex32array_(void *x, unsigned int *n) {
  popNarray((char *)x,(*n*32)) ;
}
void lookcomplex32array_(void *x, unsigned int *n) {
  lookNarray((char *)x,(*n*32)) ;
}

/****** Exported PUSH/POP/LOOK functions for F95 POINTERS: ******/

void pushpointer4_(void *ppp) {
  pushNarray((char *)ppp, 4) ;
}

void lookpointer4_(void *ppp) {
  lookNarray((char *)ppp, 4) ;
}

void poppointer4_(void *ppp) {
  popNarray((char *)ppp, 4) ;  
}

void pushpointer8_(void *ppp) {
  pushNarray((char *)ppp, 8) ;
}

void lookpointer8_(void *ppp) {
  lookNarray((char *)ppp, 8) ;
}

void poppointer8_(void *ppp) {
  popNarray((char *)ppp, 8) ;  
}

/*   --> Called from C:                                   */

void pushcharacterarray(char *x, int n) {
  pushNarray(x,(unsigned int)n) ;
}
void popcharacterarray(char *x, int n) {
  popNarray(x,(unsigned int)n) ;
}
void lookcharacterarray(char *x, int n) {
  lookNarray(x,(unsigned int)n) ;
}

void pushbooleanarray(char *x, int n) {
  pushNarray(x,(unsigned int)(n*4)) ;
}
void popbooleanarray(char *x, int n) {
  popNarray(x,(unsigned int)(n*4)) ;
}
void lookbooleanarray(char *x, int n) {
  lookNarray(x,(unsigned int)(n*4)) ;
}

void pushinteger4array(int *x, int n) {
  pushNarray((char *)x,(unsigned int)(n*4)) ;
}
void popinteger4array(int *x, int n) {
  popNarray((char *)x,(unsigned int)(n*4)) ;
}
void lookinteger4array(int *x, int n) {
  lookNarray((char *)x,(unsigned int)(n*4)) ;
}

void pushinteger8array(long int *x, int n) {
  pushNarray((char *)x,(unsigned int)(n*8)) ;
}
void popinteger8array(long int *x, int n) {
  popNarray((char *)x,(unsigned int)(n*8)) ;
}
void lookinteger8array(long int *x, int n) {
  lookNarray((char *)x,(unsigned int)(n*8)) ;
}

void pushinteger16array(long long int *x, int n) {
  pushNarray((char *)x,(unsigned int)(n*16)) ;
}
void popinteger16array(long long int *x, int n) {
  popNarray((char *)x,(unsigned int)(n*16)) ;
}
void lookinteger16array(long long int *x, int n) {
  lookNarray((char *)x,(unsigned int)(n*16)) ;
}

void pushreal4array(float *x, int n) {
  pushNarray((char *)x, (unsigned int)(n*4)) ;
}
void popreal4array(float *x, int n) {
  popNarray((char *)x, (unsigned int)(n*4)) ;
}
void lookreal4array(float *x, int n) {
  lookNarray((char *)x, (unsigned int)(n*4)) ;
}

void pushreal8array(double *x, int n) {
  pushNarray((char *)x,(unsigned int)(n*8)) ;
}
void popreal8array(double *x, int n) {
  popNarray((char *)x,(unsigned int)(n*8)) ;
}
void lookreal8array(double *x, int n) {
  lookNarray((char *)x,(unsigned int)(n*8)) ;
}

void pushreal16array(void *x, int n) {
  pushNarray((char *)x,(unsigned int)(n*16)) ;
}
void popreal16array(void *x, int n) {
  popNarray((char *)x,(unsigned int)(n*16)) ;
}
void lookreal16array(void *x, int n) {
  lookNarray((char *)x,(unsigned int)(n*16)) ;
}

void pushreal32array(void *x, int n) {
  pushNarray((char *)x,(unsigned int)(n*32)) ;
}
void popreal32array(void *x, int n) {
  popNarray((char *)x,(unsigned int)(n*32)) ;
}
void lookreal32array(void *x, int n) {
  lookNarray((char *)x,(unsigned int)(n*32)) ;
}

void pushcomplex4array(void *x, int n) {
  pushNarray((char *)x,(unsigned int)(n*4)) ;
}
void popcomplex4array(void *x, int n) {
  popNarray((char *)x,(unsigned int)(n*4)) ;
}
void lookcomplex4array(void *x, int n) {
  lookNarray((char *)x,(unsigned int)(n*4)) ;
}

void pushcomplex8array(void *x, int n) {
  pushNarray((char *)x,(unsigned int)(n*8)) ;
}
void popcomplex8array(void *x, int n) {
  popNarray((char *)x,(unsigned int)(n*8)) ;
}
void lookcomplex8array(void *x, int n) {
  lookNarray((char *)x,(unsigned int)(n*8)) ;
}

void pushcomplex16array(void *x, int n) {
  pushNarray((char *)x,(unsigned int)(n*16)) ;
}
void popcomplex16array(void *x, int n) {
  popNarray((char *)x,(unsigned int)(n*16)) ;
}
void lookcomplex16array(void *x, int n) {
  lookNarray((char *)x,(unsigned int)(n*16)) ;
}

void pushcomplex32array(void *x, int n) {
  pushNarray((char *)x,(unsigned int)(n*32)) ;
}
void popcomplex32array(void *x, int n) {
  popNarray((char *)x,(unsigned int)(n*32)) ;
}
void lookcomplex32array(void *x, int n) {
  lookNarray((char *)x,(unsigned int)(n*32)) ;
}

void pushpointer4array(void *x, int n) {
  pushNarray((char *)x, (unsigned int)(n*4)) ;
}
void poppointer4array(void *x, int n) {
  popNarray((char *)x, (unsigned int)(n*4)) ;
}
void lookpointer4array(void *x, int n) {
  lookNarray((char *)x, (unsigned int)(n*4)) ;
}

void pushpointer8array(void *x, int n) {
  pushNarray((char *)x,(unsigned int)(n*8)) ;
}
void poppointer8array(void *x, int n) {
  popNarray((char *)x,(unsigned int)(n*8)) ;
}
void lookpointer8array(void *x, int n) {
  lookNarray((char *)x,(unsigned int)(n*8)) ;
}

/************* Debug displays of the state of the stack: ***********/

void printbigbytes(long int nbblocks, long int blocksz, long int nbunits) {
  long int a3, b3, res3, res6, res9, res12 ;
  int a0, b0, res0 ;
  int printzeros = 0 ;
  a0 = (int)nbblocks%1000 ;
  a3 = nbblocks/1000 ;
  b0 = (int)blocksz%1000 ;
  b3 = blocksz/1000 ;
  res0 = ((int)(nbunits%1000)) + a0*b0 ;
  res3 = nbunits/1000 + a3*b0 + a0*b3 ;
  res6 = a3*b3 ;
  res3 += ((long int)(res0/1000)) ;
  res0 = res0%1000 ;
  res6 += res3/1000 ;
  res3 = res3%1000 ;
  res9 = res6/1000 ;
  res6 = res6%1000 ;
  res12 = res9/1000 ;
  res9 = res9%1000 ;
  if (res12>0) {
    printf("%li ", res12) ;
    printzeros = 1 ;
  }
  if ((res9/100)>0 || printzeros) {
    printf("%li",res9/100) ;
    printzeros = 1 ;
    res9 = res9%100 ;
  }
  if ((res9/10)>0 || printzeros) {
    printf("%li",res9/10) ;
    printzeros = 1 ;
    res9 = res9%10 ;
  }
  if (res9>0 || printzeros) {
    printf("%li ",res9) ;
    printzeros = 1 ;
  }
  if ((res6/100)>0 || printzeros) {
    printf("%li",res6/100) ;
    printzeros = 1 ;
    res6 = res6%100 ;
  }
  if ((res6/10)>0 || printzeros) {
    printf("%li",res6/10) ;
    printzeros = 1 ;
    res6 = res6%10 ;
  }
  if (res6>0 || printzeros) {
    printf("%li ",res6) ;
    printzeros = 1 ;
  }
  if ((res3/100)>0 || printzeros) {
    printf("%li",res3/100) ;
    printzeros = 1 ;
    res3 = res3%100 ;
  }
  if ((res3/10)>0 || printzeros) {
    printf("%li",res3/10) ;
    printzeros = 1 ;
    res3 = res3%10 ;
  }
  if (res3>0 || printzeros) {
    printf("%li ",res3) ;
    printzeros = 1 ;
  }
  if ((res0/100)>0 || printzeros) {
    printf("%i",res0/100) ;
    printzeros = 1 ;
    res0 = res0%100 ;
  }
  if ((res0/10)>0 || printzeros) {
    printf("%i",res0/10) ;
    printzeros = 1 ;
    res0 = res0%10 ;
  }
  printf("%i",res0) ;
}

void printctraffic_() {
  printf(" C Traffic: ") ;
  printbigbytes(mmctrafficM, 1000000, mmctraffic) ;
  printf(" bytes\n") ;
}

void printftrafficinc_(long int *mmfM, int *mmfsz, int *mmf) {
  printf(" F Traffic: ") ;
  printbigbytes(*mmfM, (long int)*mmfsz, (long int)*mmf) ;
  printf(" bytes\n") ;
}

void printtotaltraffic_(long int *mmfM, int *mmfsz, int *mmf) {
  printf(" C+F Traffic: ") ;
  printbigbytes(mmctrafficM, 1000000, mmctraffic) ;
  printf(" + ");
  printbigbytes(*mmfM, (long int)*mmfsz, (long int)*mmf) ;
  printf(" bytes\n") ;
}

void printtopplace_() {
    DoubleChainedBlock *stack = curStack ;
    int nbBlocks = (stack?-1:0) ;
    int remainder = 0;
    while(stack) {
        stack = stack->prev ;
        nbBlocks++ ;
    }
    if (curStack && curStackTop) remainder = curStackTop-(curStack->contents) ;
    printf(" Stack size: ") ;
    printbigbytes((long int)nbBlocks, ONE_BLOCK_SIZE, (long int)remainder) ;
    printf(" bytes\n") ;
}

void printtopplacenum_(int *n) {
    DoubleChainedBlock *stack = curStack ;
    int nbBlocks = (stack?-1:0) ;
    int remainder = 0;
    while(stack) {
        stack = stack->prev ;
        nbBlocks++ ;
    }
    if (curStack && curStackTop) remainder = curStackTop-(curStack->contents) ;
    printf(" Stack size at location %i : ", *n) ;
    printbigbytes((long int)nbBlocks, ONE_BLOCK_SIZE, (long int)remainder) ;
    printf(" bytes\n") ;
}

void printstackmax_() {
    DoubleChainedBlock *stack = curStack ;
    int nbBlocks = (stack?-2:0) ;
    int remainder = 0;
    long int totalsz ;
    while(stack) {
        stack = stack->prev ;
        nbBlocks++ ;
    }
    stack = curStack ;
    while(stack) {
        stack = stack->next ;
        nbBlocks++ ;
    }
    
    printf(" Max Stack size (%i blocks): ", nbBlocks) ;
    printbigbytes((long int)nbBlocks, ONE_BLOCK_SIZE, (long int)0) ;
    printf(" bytes\n") ;
}

void printlookingplace_() {
    if (lookStack == NULL)
        printtopplace_() ;
    else {
        DoubleChainedBlock *stack = lookStack ;
        int nbBlocks = (stack?-1:0) ;
        while(stack) {
            stack = stack->prev ;
            nbBlocks++ ;
        }
        printf(" Stack look at: ") ;
        printbigbytes((long int)nbBlocks, ONE_BLOCK_SIZE,
                      ((long int)(lookStackTop-(lookStack->contents)))) ;
        printf(" bytes\n") ;
    }
}

void showrecentcstack_() {
  if (curStack && curStackTop) {
    int totalNumChars = 60 ;
    DoubleChainedBlock *stack = curStack ;
    char *stackTop = curStackTop ;
    unsigned short int *st1 ;
    printf("TOP OF C STACK  : ") ;
    while (totalNumChars>0 && stackTop>(stack->contents)) {
      stackTop-- ;
/* ATTENTION!! en 64 bits, unsigned short int fait 2 octets, donc ce print est un peu faux */
      st1 = (unsigned short int *)stackTop ;
      printf("%02X,",*st1%256) ;
      totalNumChars-- ;
    }
    while (totalNumChars>0 && stack->prev) {
      printf(" || ") ;
      stack = stack->prev ;
      stackTop = (stack->contents)+ONE_BLOCK_SIZE ;
      while (totalNumChars>0 && stackTop>(stack->contents)) {
        stackTop-- ;
        st1 = (unsigned short int *)stackTop ;
        printf("%02X,",*st1%256) ;
        totalNumChars-- ;
      }
    }
    if (stack->prev || stackTop>(stack->contents))
      printf(" ...\n") ;
    else
      printf(" || BOTTOM\n") ;
  } else {
    printf("NOTHING IN C STACK.\n") ;
  }
}

void getnbblocksinstack_(int *nbblocks) {
  DoubleChainedBlock *stack = curStack ;
  *nbblocks = 0 ;
  while(stack) {
    stack = stack->prev ;
    (*nbblocks)++ ;
  }
}

/* Computes (and returns into its args) the number of blocks below the current
 * stack top (resp. look) position, and the number of bytes below
 * the current top (resp. look) position in the topmost block of the current
 * top (resp. look) position. */
void getbigcsizes_(int *nbblocks, int *remainder, int *nbblockslook, int *lookremainder) {
  DoubleChainedBlock *stack ;

  stack = curStack ;
  *nbblocks = (stack?-1:0) ;
  while(stack) {
    stack = stack->prev ;
    (*nbblocks)++ ;
  }
  if (curStack && curStackTop)
    *remainder = curStackTop-(curStack->contents) ;
  else
    *remainder = 0 ;

  if (lookStack == NULL) {
    *nbblockslook = -999 ;
    *lookremainder = -999 ;
  } else {
    stack = lookStack ;
    *nbblockslook = (stack?-1:0) ;
    while(stack) {
      stack = stack->prev ;
      (*nbblockslook)++ ;
    }
    *lookremainder = lookStackTop-(lookStack->contents) ;
  }
}