From 1b225a28090a99ab56134cf60e938ab131fb0d6e Mon Sep 17 00:00:00 2001
From: etagle <ejtagle@hotmail.com>
Date: Wed, 9 May 2018 23:54:42 -0300
Subject: [PATCH] DUE: Emergency parser for the USB CDC

---
 .../src/HAL/HAL_DUE/MarlinSerialUSB_Due.cpp   | 21 ++++++++++++++++++-
 1 file changed, 20 insertions(+), 1 deletion(-)

diff --git a/Marlin/src/HAL/HAL_DUE/MarlinSerialUSB_Due.cpp b/Marlin/src/HAL/HAL_DUE/MarlinSerialUSB_Due.cpp
index dc8edf9a3a..eed4c73999 100644
--- a/Marlin/src/HAL/HAL_DUE/MarlinSerialUSB_Due.cpp
+++ b/Marlin/src/HAL/HAL_DUE/MarlinSerialUSB_Due.cpp
@@ -33,6 +33,10 @@
 
 #include "MarlinSerialUSB_Due.h"
 
+#if ENABLED(EMERGENCY_PARSER)
+  #include "../../feature/emergency_parser.h"
+#endif
+
 // Imports from Atmel USB Stack/CDC implementation
 extern "C" {
   bool usb_task_cdc_isenabled(void);
@@ -46,6 +50,10 @@ extern "C" {
 // Pending character
 static int pending_char = -1;
 
+#if ENABLED(EMERGENCY_PARSER)
+  static EmergencyParser::State emergency_state; // = EP_RESET
+#endif
+
 // Public Methods
 void MarlinSerialUSB::begin(const long baud_setting) {
 }
@@ -66,6 +74,11 @@ int MarlinSerialUSB::peek(void) {
     return -1;
 
   pending_char = udi_cdc_getc();
+
+  #if ENABLED(EMERGENCY_PARSER)
+    emergency_parser.update(emergency_state, (char)pending_char);
+  #endif
+
   return pending_char;
 }
 
@@ -84,7 +97,13 @@ int MarlinSerialUSB::read(void) {
   if (!udi_cdc_is_rx_ready())
     return -1;
 
-  return udi_cdc_getc();
+  int c = udi_cdc_getc();
+
+  #if ENABLED(EMERGENCY_PARSER)
+    emergency_parser.update(emergency_state, (char)c);
+  #endif
+
+  return c;
 }
 
 bool MarlinSerialUSB::available(void) {