51 lines
650 B
C++
51 lines
650 B
C++
|
|
/*
|
|
* F14Handler.cpp
|
|
*
|
|
* Created on: 2014/07/21
|
|
* Author: MattLech
|
|
*/
|
|
|
|
#include "F14Handler.h"
|
|
|
|
static F14Handler *instance;
|
|
|
|
F14Handler *F14Handler::getInstance()
|
|
{
|
|
if (!instance)
|
|
{
|
|
instance = new F14Handler();
|
|
};
|
|
return instance;
|
|
};
|
|
|
|
F14Handler::F14Handler()
|
|
{
|
|
}
|
|
|
|
int F14Handler::execute(Command *command)
|
|
{
|
|
|
|
int ret = 0;
|
|
|
|
if (LOGGING)
|
|
{
|
|
Serial.print("R99 CALIBRATE X\r\n");
|
|
}
|
|
|
|
ret = Movement::getInstance()->calibrateAxis(0);
|
|
|
|
|
|
if (ret == 0) {
|
|
Movement::getInstance()->moveToCoords(0,0,0, 0,0,0, true, false, false);
|
|
}
|
|
|
|
|
|
if (LOGGING)
|
|
{
|
|
CurrentState::getInstance()->print();
|
|
}
|
|
|
|
return 0;
|
|
}
|