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

#include "util.h"
#include "sia.h"


extern int new_block (int fd, SIA_Block *b, int log);
//extern void periodic_task(void);


static int usage (const char *name)
{
  fprintf (stderr, "Usage:\n");
  fprintf (stderr, "%s [ -l ] [ -b baud ] -p serial_device\n\n", name);
  fprintf (stderr, "baud defaults to 9600\n");

  return 1;
}


int main (int argc, char *argv[])
{
  const char *port;
  int baud = 9600;
  unsigned opt;
  int fd;
  SIA_Block b;
  ssize_t red;
  int log = 0;

  unsigned char buf[SIA_MAX_BLOCK_LENGTH];
  unsigned ptr = 0;


  while ((opt = getopt (argc, argv, "p:b:l:")) != -1) {
    switch (opt) {
    case 'p':
      port = optarg;
      break;

    case 'b':
      baud = atoi (optarg);
      break;

    case 'l':
      log++;
      break;


    default: /* '?' */
      return usage (argv[0]);
    }
  }



  if (!port)
    return usage (argv[0]);

  if (log)
    openlog ("serial_rx", 0, LOG_USER);

  fd = open_tty (port, baud);

  set_blocking (fd);

  for (;;) {
    red = read (fd, &buf[ptr], 1);

    if ((red < 0) || (red > 1)) {
      perror ("read");
      return 1;
    }

    if (!red) continue;

    ptr++;

    switch (sia_parse (buf, ptr, &b)) {
    case -1: /*Parse errror, flush and carry on */
      tcflush (fd, TCIFLUSH);
      ptr = 0;
      break;

    case 0: /*More data needed*/
      break;

    default: /*Valid block */
      new_block (fd, &b, log);
      ptr = 0;
      break;
    }

    if (ptr == SIA_MAX_BLOCK_LENGTH) {
      tcflush (fd, TCIFLUSH);
      ptr = 0;
    }

  }

}