/*
 * F15Handler.cpp
 *
 *  Created on: 2015/07/21
 *      Author: MattLech
 */

#include "F15Handler.h"

static F15Handler *instance;

F15Handler *F15Handler::getInstance()
{
  if (!instance)
  {
    instance = new F15Handler();
  };
  return instance;
};

F15Handler::F15Handler()
{
}

int F15Handler::execute(Command *command)
{
  int ret = 0;

  if (LOGGING)
  {
    Serial.print("R99 HOME Z\r\n");
  }

  ret = Movement::getInstance()->calibrateAxis(1);

  if (ret == 0) {
    Movement::getInstance()->moveToCoords(0, 0, 0, 0, 0, 0, false, true, false);
  }

  if (LOGGING)
  {
    CurrentState::getInstance()->print();
  }

  return 0;
}