#include <stdbool.h>
#include <stdint.h>
#include <stdlib.h>
#include <string.h>

#ifdef LINUX
#include <stdio.h>
#endif

#include "interpret.h"
#include "mTaskSymbols.h"
#include "sds.h"
#include "spec.h"
#include "task.h"
#include "interface.h"

#define MSG_GET_TASK 't'
#define MSG_DEL_TASK 'd'
#define MSG_SDS_SPEC 's'
#define MSG_SDS_DEL 'a'
#define MSG_SDS_UPD 'u'
#define MSG_SPEC 'c'

#define LOOPDELAY 100

void read_message(void)
{
  //Find next task
  if (input_available()) {
    uint8_t c = read_byte();
    debug("Receiving input: %c %02x\n", c, c);
    switch (c) {
      case MSG_SDS_SPEC:
        debug("Receiving an sds");
        sds_register();
        break;
      case MSG_SDS_UPD:
        debug("Receiving an sds update");
        //TODO do something with the return value
        c = read16();
        sds_update(c);
        break;
      case MSG_SDS_DEL:
        debug("Receiving a delete SDS request");
        c = read16();
        sds_delete(c);
        write_byte('a');
        write16(c);
        write_byte('\n');
        break;
      case MSG_DEL_TASK:
        debug("Receiving a delete task request");
        c = read16();
        task_delete(c);
        //Write acknowledgement
        write_byte('d');
        write16(c);
        write_byte('\n');
        break;
      case MSG_GET_TASK:
        debug("Receiving a task");
        task_register();
        break;
      case MSG_SPEC:
        debug("Receiving a spec request");
        spec_send();
        break;
      case '\0':
        debug("Server closed connection");
        break;
      case '\n':
        break;
      default:
        debug("Unknown message: %X", c);
    }
  } else {
    //		debug("No input");
  }
}

unsigned long loopmillis = 0;
void loop(void)
{
#if defined ARDUINO_ESP8266_NODEMCU || defined ARDUINO_AVR_UNO
  if (getmillis() - loopmillis < LOOPDELAY) {
    return;
  }
  loopmillis = getmillis();
#endif
  read_message();

  //Run tasks
  unsigned long cyclestart = getmillis();
  for (struct task *t = task_head(); t != NULL; t = task_next(t)) {
    //interrupt task
    if (is_interrupt_task(t) && had_interrupt(t)) {
      debug("Interrupt task %d not implemented", t->taskid);
      run_task(t);
      //Interval task, and interval passed
    } else if (cyclestart - t->lastrun > t->interval) {
      debug("Running interval task: %d", t->taskid);
      run_task(t);

      //Oneshot task, thus disable
      if (t->interval == 0) {
        task_delete(t->taskid);
      }
      t->lastrun = cyclestart;
    }
  }
}

#ifdef STM
int main(void) {
#elif defined ARDUINO_ESP8266_NODEMCU || defined ARDUINO_AVR_UNO
void setup() {
#elif defined LINUX
int main(int argc, char *argv[]) {
  gargc = argc;
  gargv = argv;
#endif

  //Initialize device independant functionality
  real_setup();

#if !defined(ARDUINO_ESP8266_NODEMCU) && !defined(ARDUINO_AVR_UNO)
  while (true) {
    //Check for newtasks
    loop();
    msdelay(LOOPDELAY);
  }

  return 0;
#endif
}