/*
   * Very basic emulation of an Arduino UNO with some buttons and some LEDs
   */
  
  ////
  // Include files
  ////
  #include <stdio.h>
  #include <stdlib.h>
  #include <unistd.h>
  #include <string.h>
  #include <sys/poll.h>
  #include <sys/time.h>
  #include <stdbool.h>
  
  #include "virtual_serial.h"
  #include "arduino.h"
  
  ////
  // Constants
  ////
  #define		SERIAL_SPEED		9600
  #define		SLEEP_DELAY		100
  
  #define		MAX_NAME		1024
  #define		MAX_LINE		1024
  #define		MAX_SERIAL		1024
  
  ////
  // Global variables
  ////
  
  ////
  // Utility functions
  ////
  
  static unsigned char ledstates[LEDS_NB];
  void led(int num,unsigned char state){
  if(num>=0 && num<LEDS_NB) ledstates[num]=state;
  int i;
  printf("   LEDs: ");
  for(i=0;i<LEDS_NB;i++) printf("[%c] ",ledstates[i]?'X':' ');
  printf("\r");
  fflush(stdout);
  }
  
  static unsigned char outbuf[MAX_SERIAL];
  int outsize=0;
  void serialSend(unsigned char *data,int size){
  if(size+outsize<MAX_SERIAL){
    memcpy(outbuf+outsize,data,size);
    }
  }
  
  static unsigned char butstates[BUTTONS_NB];
  static void _button(int num,unsigned char state){
  if(num>=0 && num<BUTTONS_NB) butstates[num]=state;
  int i;
  printf("Buttons: ");
  for(i=0;i<BUTTONS_NB;i++) printf("[%c] ",(butstates[i]?'A':'a')+i);
  printf("\n");
  }
  
  unsigned char button(int num){
  if(num>=0 && num<BUTTONS_NB) return butstates[num];
  return 255;
  }
  
  long millis(void){
  struct timeval tv;
  gettimeofday(&tv,NULL);
  return tv.tv_sec*1000+tv.tv_usec/1000;
  }
  
  ////
  // Events function
  ////
  
  static void handleEvents(int sd){
  struct pollfd fds[2];
  char line[MAX_LINE];

  int ret;
  // my variables 

  unsigned char packet[MAX_SERIAL];
  

  //
  fds[0].fd=STDIN_FILENO;
  fds[0].events=POLLIN;
  fds[1].fd=sd;
  fds[1].events=POLLIN;
  
  while(1){
    

    if (butstates[0] == 1 && butstates[1] == 0 && butstates[2] == 0 && butstates[3] == 0)

    {

  	loop();

    }
    ret=poll(fds,2,SLEEP_DELAY);
    if(ret==-1){ perror("poll"); exit(EXIT_FAILURE); }
    if(fds[0].revents&POLLIN){
      if(fgets(line,MAX_LINE,stdin)==NULL){ perror("fgets"); exit(EXIT_FAILURE); } 
  #ifdef DEBUG
      printf("keyboard: %s",line);
  #endif
      int i;
      for(i=0;i<strlen(line);i++){
        if(line[i]>='a' && line[i]<='d') _button(line[i]-'a',0);
        if(line[i]>='A' && line[i]<='D') _button(line[i]-'A',1);
        }
      }
    if(fds[1].revents&POLLIN){
      int nb;
      if((nb=read(sd,packet,MAX_SERIAL))<=0) break;
  #ifdef DEBUG
      printf("serial in: ");
  #endif
      int i;

      for(i=0;i<nb;i++){
  #ifdef DEBUG

  	printf("%02x ",packet[i]);

  #endif

  	serialInHandler(packet[i]);
        	

        }

  #ifdef DEBUG
      printf("\n");
  #endif
      }

    if(outsize>0){
      if(write(sd,outbuf,outsize)!=outsize) break;
  #ifdef DEBUG
      printf("serial out: ");
      int i;
      for(i=0;i<outsize;i++){
        printf("%02x ",outbuf[i]);
        }
      printf("\n");
  #endif
      outsize=0;
      }
    }
  }
  
  ////
  // Main function
  ////
  
  int main(void){
  char name[MAX_NAME];
  int sd=virtualSerialOpen(name,SERIAL_SPEED);
  printf("Slave device is '%s'\n",name);
  setup();
  handleEvents(sd);
  virtualSerialClose(sd);
  exit(0);
  }