/* PL155-P control */

#include <stdio.h>   /* Standard input/output definitions    */
#include <string.h>  /* String function definitions          */
#include <unistd.h>  /* UNIX standard function definitions   */
#include <fcntl.h>   /* File control definitions             */
#include <errno.h>   /* Error number definitions             */
#include <termios.h> /* POSIX terminal control definitions   */

#define Wsize 32

int fd;
unsigned char Word[Wsize];

int InitPort(void)
  {
    struct termios options;

    fd = open("/dev/ttyS0", O_RDWR | O_NOCTTY | O_NDELAY);

    if (fd == -1)
      {
        fputs("Unable to open port\n", stdout);
        return 0;
      }
    else
      {
        tcgetattr(fd, &options);

        cfsetispeed(&options, B9600);        /* Set the input  baud rate   */
        cfsetospeed(&options, B9600);        /* Set the output baud rate   */

        options.c_cflag |= (CLOCAL | CREAD); /* Enable receiver, set local */

        options.c_cflag &= ~PARENB;          /* Clear parity enable        */
        options.c_cflag &= ~CSTOPB;          /* Remove 2nd stop bit        */
        options.c_cflag &= ~CSIZE;           /* Clear data length          */
        options.c_cflag |= CS8;              /* Character size = 8 bits    */

        options.c_lflag &= ~(ICANON | ECHO | ECHOE | ISIG);  /* RAW input  */
        options.c_oflag &= ~OPOST;                           /* RAW output */

        options.c_cflag &= ~CRTSCTS;      /* Disable hardware flow control */

        tcsetattr(fd, TCSANOW, &options);    /* set attributes immediately */;

        return 1;
      }
  }

void WritePort(char Command[])
  {
    char *BufPtr;
    int i;

    BufPtr = Command;

    for (i=0; i<strlen(Command); i++)
      {
        usleep(100);
        write(fd, BufPtr, 1);
        BufPtr++;
      }
  }

int ReadPort(unsigned char *wPtr)
{
  int i;

  for (i=0; i<Wsize; i++) wPtr[i]= 0x00;

  i=0;
  while (i<Wsize)
    {
     usleep(100);
     while(read(fd, wPtr, 1)<0){}
     if ((( wPtr[-1]=='\r') || ( wPtr[-1]=='\n')) &&
	 ((*wPtr    =='\r') || (*wPtr    =='\n'))) break;
     wPtr++;
     i++;
    }

  return i;
}

void PL155init(void)
{
//  WritePort("*RST\n");

  WritePort("IFLOCK\n");
  WritePort("IRANGE1 2\n");

  WritePort("OCP1 5.000\n");
  WritePort("OVP1 5.000\n");

//  WritePort("I1 0.000\n");
  WritePort("V1 0.000\n");

  WritePort("DELTAI1 0.001\n");
  WritePort("DELTAV1 0.001\n");

  WritePort("OP1 1\n");
}


void PL155end(void)
{
  WritePort("IFUNLOCK\n");
  WritePort("LOCAL\n");
}


int main(void)
{
  int i;

  if (!InitPort()) return 0;

  PL155init();
  WritePort("V1 4.000\n");
  PL155end();

  close(fd);

  return 1;
}