// Hexapod FireFly

#include "hexapod.h"

#include "Gedrags_Classen.cpp"

//Watchdog WD;
//Ultrasone US;
hexapod *FireFly = new hexapod;

void setup()
{
  Serial.begin(38400);
  Serial1.begin(38400);
  pinMode(13, OUTPUT);

  FireFly->FireFly();
}

// Main loop.
void loop()
{
  DataObject *cache = new DataObject;
  
  cache->input(5, 3, 8, 8, 3, 0, 5, 3, -8, 5, 3, 8, 8, 3, 0, 5, 3, -8, 500);

  //WD.CheckTime(DataLine);

  FireFly->CoreSend(cache);
}