/* vtpserver.c */

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

#if defined(Linux_armv7l)

#include <sys/mman.h>
#include <sys/signal.h>
#include <sys/time.h>
#include <sys/types.h>
#include <fcntl.h>
#include <pthread.h>

#ifdef IPC
#include "ipc.h"
#endif // IPC

#include "vtpLib.h"

void sig_handler(int signo);

int
load_firmware()
{
  FILE *f;
  char buf[1000], host[100], hostfile[100], z7file[100], v7file[100];
  int i;

  sprintf(buf, "%s/firmwares/vtp_firmware.txt", getenv(VTP_CONFIG_GET_ENV));

  f = fopen(buf, "rt");
  if(!f)
  {
    printf("%s: Error - failed to open: %s\n", __func__, buf);
    return -1;
  }

  gethostname(host,sizeof(host));
  for(i=0; i<strlen(host); i++)
  {
    if(host[i] == '.')
    {
      host[i] = '\0';
      break;
    }
  }

  while(!feof(f))
  {
    fgets(buf, sizeof(buf), f);

    if(sscanf(buf, "%100s %100s %100s", hostfile, z7file, v7file) >= 3)
    {
      if(!strcmp(hostfile, host))
      {
        printf("%s: Found host %s, z7file: %s, v7file: %s\n", __func__, hostfile, z7file, v7file);

        sprintf(buf, "%s/firmwares/%s", getenv(VTP_CONFIG_GET_ENV), z7file);
        if(vtpZ7CfgLoad(buf) != OK)
        {
          printf("Z7 programming failed...\n");
          return -1;
        }

        sprintf(buf, "%s/firmwares/%s", getenv(VTP_CONFIG_GET_ENV), v7file);
        if(vtpV7CfgLoad(buf) != OK)
        {
          printf("V7 programming failed...\n");
          return -1;
        }

        printf("Programming succeeded!\n");
        break;
      }
    }
  }

  fclose(f);
  return 0;
}

int
main(int argc, char *argv[])
{
  int stat;
#ifdef IPC
  int count;
  pthread_t gScalerThread;
#endif // IPC

  if(signal(SIGINT, sig_handler) == SIG_ERR)
  {
    perror("signal");
    exit(0);
  }

  stat = vtpOpen(VTP_FPGA_OPEN|VTP_I2C_OPEN|VTP_SPI_OPEN);
  if(stat != (VTP_FPGA_OPEN|VTP_I2C_OPEN|VTP_SPI_OPEN))
    goto CLOSE;
  else
    printf("vtpOpen'ed\n");

  /* read vtp firmware table and load into vtp here */
  if(load_firmware())
  {
    printf("Unable to load firmware - exiting...\n");
    goto CLOSE;
  }

  ltm4676_print_status();

  if(vtpInit(VTP_INIT_CLK_INT))
  {
    printf("VTP Init failed - exiting...\n");
    goto CLOSE;
  }

#ifdef IPC
  /* connect to IPC server */
  printf("Connect to IPC server...\n");
  //epics_json_msg_sender_init(getenv("EXPID"), getenv("SESSION"), "daq", "HallB_DAQ");
  epics_json_msg_sender_init("clasrun", "clasprod", "daq", "HallB_DAQ");
  printf("done.\n");
  fflush(stdout);

  stat = fork();
  if(!stat)
  {
    system("/home/daq/src/DiagGui/DiagGuiServer");
    return 0;
  }

  count = 0;
  while(1)
  {
    count ++;
    sleep(1);
    vtpSendScalers();
    if((count%10)==0) vtpSendSerdes();
  }
#endif // IPC

CLOSE:

#ifdef IPC
  /* disconnect from IPC server */
  epics_json_msg_close();
#endif // IPC

  vtpClose(VTP_FPGA_OPEN|VTP_I2C_OPEN|VTP_SPI_OPEN);
  printf("vtpClose'd\n");

  exit(0);
}

void
closeup()
{
#ifdef IPC
  epics_json_msg_close();
#endif // IPC

  vtpClose(VTP_FPGA_OPEN|VTP_I2C_OPEN|VTP_SPI_OPEN);
  printf("DiagGUI server closed...\n");
}

void
sig_handler(int signo)
{
  printf("%s: signo = %d\n",__FUNCTION__,signo);
  switch(signo)
  {
    case SIGINT:
      closeup();
      exit(1);  /* exit if CRTL/C is issued */
  }
}

#else

int
main()
{
}

#endif