 
 String commands[COMMANDS_COUNT];
 int8_t _cmdsIndex = 0;
-
+uint8_t _plannedCount = 0;
 int8_t _power = 0;
 int16_t _speed = 0;
 int16_t _accel = 0;

}
void lineTo(long x, long y)
{
    openPower();
#ifdef DEBUG
    String str = "line:";

    uint8_t speed = 20;
    uint8_t accel = 20;
};
struct PlannerPoint
{
};
struct SystemStatus
{
    bool running = false;
    long currentPosition[NUM_AXIS];
    long targetPosition[NUM_AXIS];
};
SystemStatus _sys;
PlannerPoint _points[STATES_COUNT];
MotionState _states[STATES_COUNT];
MotionState _state;
CommandState _commState;
