/**
 * Marlin 3D Printer Firmware
 * Copyright (C) 2016 MarlinFirmware [https://github.com/MarlinFirmware/Marlin]
 *
 * Based on Sprinter and grbl.
 * Copyright (C) 2011 Camiel Gubbels / Erik van der Zalm
 *
 * This program is free software: you can redistribute it and/or modify
 * it under the terms of the GNU General Public License as published by
 * the Free Software Foundation, either version 3 of the License, or
 * (at your option) any later version.
 *
 * This program is distributed in the hope that it will be useful,
 * but WITHOUT ANY WARRANTY; without even the implied warranty of
 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
 * GNU General Public License for more details.
 *
 * You should have received a copy of the GNU General Public License
 * along with this program.  If not, see <http://www.gnu.org/licenses/>.
 *
 */

/**
 * emergency_parser.cpp - Intercept special commands directly in the serial stream
 */

#include "../inc/MarlinConfigPre.h"

#if ENABLED(EMERGENCY_PARSER)

#include "emergency_parser.h"

extern volatile bool wait_for_user, wait_for_heatup;
void quickstop_stepper();

EmergencyParser::State EmergencyParser::state = EmergencyParser::State::RESET;
bool EmergencyParser::killed_by_M112; // = false

EmergencyParser emergency_parser;

void EmergencyParser::update(const uint8_t c) {

  switch (state) {
    case EmergencyParser::State::RESET:
      switch (c) {
        case ' ': break;
        case 'N': state = EmergencyParser::State::N;      break;
        case 'M': state = EmergencyParser::State::M;      break;
        default: state  = EmergencyParser::State::IGNORE;
      }
      break;

    case EmergencyParser::State::N:
      switch (c) {
        case '0': case '1': case '2':
        case '3': case '4': case '5':
        case '6': case '7': case '8':
        case '9': case '-': case ' ':   break;
        case 'M': state = EmergencyParser::State::M;      break;
        default:  state = EmergencyParser::State::IGNORE;
      }
      break;

    case EmergencyParser::State::M:
      switch (c) {
        case ' ': break;
        case '1': state = EmergencyParser::State::M1;     break;
        case '4': state = EmergencyParser::State::M4;     break;
        default: state  = EmergencyParser::State::IGNORE;
      }
      break;

    case EmergencyParser::State::M1:
      switch (c) {
        case '0': state = EmergencyParser::State::M10;    break;
        case '1': state = EmergencyParser::State::M11;    break;
        default: state  = EmergencyParser::State::IGNORE;
      }
      break;

    case EmergencyParser::State::M10:
      state = (c == '8') ? EmergencyParser::State::M108 : EmergencyParser::State::IGNORE;
      break;

    case EmergencyParser::State::M11:
      state = (c == '2') ? EmergencyParser::State::M112 : EmergencyParser::State::IGNORE;
      break;

    case EmergencyParser::State::M4:
      state = (c == '1') ? EmergencyParser::State::M41 : EmergencyParser::State::IGNORE;
      break;

    case EmergencyParser::State::M41:
      state = (c == '0') ? EmergencyParser::State::M410 : EmergencyParser::State::IGNORE;
      break;

    case EmergencyParser::State::IGNORE:
      if (c == '\n') state = EmergencyParser::State::RESET;
      break;

    default:
      if (c == '\n') {
        switch (state) {
          case EmergencyParser::State::M108:
            wait_for_user = wait_for_heatup = false;
            break;
          case EmergencyParser::State::M112:
            killed_by_M112 = true;
            break;
          case EmergencyParser::State::M410:
            quickstop_stepper();
            break;
          default:
            break;
        }
        state = EmergencyParser::State::RESET;
      }
  }
}

#endif // EMERGENCY_PARSER