// Include.
#include <math.h>
#include "InverseKinemetics.h"
#include "SSC32.h"
#include "sequnces.h"
#include "Orbit.h"
#include "Data_Manager.h"

// Classes.
InverseKinemetics ik;
SSC32 body;
Orbit orbit;

// Nunchuck.
#include "WiiChuck.h"

#define MAXANGLE 90
#define MINANGLE -90

WiiChuck chuck = WiiChuck();
int angleStart, currentAngle;
int tillerStart = 100;
double angle;

// Functions.
void FireFly()
{
  Serial.println("");
  Serial.println(" ____                     ____    ___                ");
  Serial.println("/\\  _`\\   __             /\\  _`\\ /\\_ \\               ");
  Serial.println("\\ \\ \\L\\_\\/\\_\\  _ __    __\\ \\ \\L\\_\\//\\ \\    __  __    ");
  Serial.println(" \\ \\  _\\/\\/\\ \\/\\`'__\\/'__`\\ \\  _\\/ \\ \\ \\  /\\ \\/\\ \\   ");
  Serial.println("  \\ \\ \\/  \\ \\ \\ \\ \\//\\  __/\\ \\ \\/   \\_\\ \\_\\ \\ \\_\\ \\  ");
  Serial.println("   \\ \\_\\   \\ \\_\\ \\_\\\\ \\____\\\\ \\_\\   /\\____\\\\/`____ \\ ");
  Serial.println("    \\/_/    \\/_/\\/_/ \\/____/ \\/_/   \\/____/ `/___/> \\");
  Serial.println("                                               /\\___/");
  Serial.println("                                               \\/__/ ");
  Serial.println("");
  Serial.println("Version 3.0");
  delay(800);
}

void warning ()
{
  digitalWrite(13, HIGH);
  delay(100);
  digitalWrite(13, LOW); 
}