#include <stdio.h>
#include <stdlib.h>
#include <unistd.h>
#include <sys/types.h>
#include <sys/stat.h>
#include <fcntl.h>

#include "ti_dsp.h"

/* ----------------------------------------------------------------------
   Boot the input ALTERA
   ---------------------------------------------------------------------- */
int ti_altera_cfg(ti_dsp_p dsp, ti_bootMode bootMode)
{
  int i;
  unsigned int n;
  struct stat fs;

  /* ---- Buffer to hold the ALTERA configuration data and timestamp */
  static unsigned int *data32 = NULL;
  static int size_altera;

  /* ---- Check if the ALTERA.dat file needs to be reloaded */
  if (stat("ALTERA.dat", &fs) < 0){
    perror("ti_altera_cfg:stat()");
    return 1;
  }

  /* ---- Load the binary file ALTERA.dat in memory */
  if (data32 == NULL){
    unsigned char *data;
    int id = open("ALTERA.dat", O_RDONLY);
    if (id==-1){
      perror("ti_altera_cfg:open()");
      return 1;
    }
    if (fstat(id, &fs)==-1){
      perror("ti_altera_cfg:fstat()");
      return 1;
    }
    size_altera = fs.st_size;
    data=(unsigned char *)malloc(size_altera);
    if (data == NULL){
      perror("ti_altera_cfg:malloc()");
      return 1;
    }
    read (id, data, size_altera);
    close(id);
    /* Expand to 32-bit words */
    data32=(unsigned int *)malloc(size_altera*sizeof(int));
    if (data32 == NULL){
      perror("ti_altera_cfg:malloc()");
      return(1);
    }
    for(i=0; i<size_altera; i++)
      data32[i] = data[i] | data[i] << 24; /* works on little and big-endian */
    free(data);
  }

  /* ---- Try to determine if ALTERA needs to be configured */
  if (bootMode == TI_AUTO && vme_dsp_read(dsp, TI_STATUS) & TI_CONF_DONE){
    fputs("ti_altera_cfg: ALTERA already configured\n", stderr);
    return 0;
  }

  /* send nCONFIG=0 pulse */
  dsp->controlWord &= ~CW_nCONFIG;
  ti_writeCW(dsp);

  /* check CONF_DONE=0 and nSTATUS=0 */
  n = vme_dsp_read(dsp, TI_STATUS);
  if((n & TI_nSTATUS) || (n & TI_CONF_DONE)){
    fputs("ti_altera_cfg: CONF_DONE or nSTATUS NOT OK after nCONFIG LOW\n", stderr);
    return 1;
  }

  /* send nCONFIG=1 */
  dsp->controlWord |= CW_nCONFIG;
  ti_writeCW(dsp);

  /* check CONF_DONE=0 and nSTATUS=1 */
  n = vme_dsp_read(dsp, TI_STATUS);
  if(!(n & TI_nSTATUS) || (n & TI_CONF_DONE)){
    fputs("ti_altera_cfg: CONF_DONE or nSTATUS NOT OK after nCONFIG HIGH\n", stderr);
    return 1;
  }

#ifdef SLOW
  /* send configuration file */
  for(i=0; i<size_altera; i++){
    vme_dsp_write(dsp, TI_ALTERA_CONFIG_DATA, data32[i]);
    if (!(i % 1000)){
      vme_check();
      n = vme_dsp_read(dsp, TI_STATUS);
      if (!(n & TI_nSTATUS)){
	fprintf(stderr, "ti_altera_cfg: Error during configuration, %d bytes sent\n", i);
	return 2;
      }
      putc('.', stderr);
    }
  }
#else
  vme_dsp_writeblk(dsp, TI_ALTERA_CONFIG_DATA, size_altera, data32);
#endif

  usleep(10000);

  /* check CONF_DONE=1 */
  n = vme_dsp_read(dsp, TI_STATUS);
  vme_check();
  if(!(n & TI_CONF_DONE)){
    fputs("ti_altera_cfg: Error, DONE=0 after loading\n", stderr);
    return 3;
  }

  fputs("ti_altera_cfg: Initialization complete\n", stderr);
  return 0;
}