diff --git a/Motate b/Motate
index 84196050..f5377edb 160000
--- a/Motate
+++ b/Motate
@@ -1 +1 @@
-Subproject commit 8419605067b474c9b69120a2cc8adf4dfdd4d0e6
+Subproject commit f5377edb0b78cf12a3a077fa92d6479626de57fd
diff --git a/g2core/controller.cpp b/g2core/controller.cpp
index 95ed767b..7c5dcbd9 100644
--- a/g2core/controller.cpp
+++ b/g2core/controller.cpp
@@ -48,6 +48,7 @@
 #ifdef ENABLE_INTERLOCK_AND_ESTOP
 #include "spindle.h"
 #endif
+#include "persistence.h"
 
 #include "MotatePower.h"
 
@@ -232,6 +233,7 @@ static void _controller_HSM()
 #if MARLIN_COMPAT_ENABLED == true
     DISPATCH(marlin_callback());                // handle Marlin stuff - may return EAGAIN, must be after planner_callback!
 #endif
+    DISPATCH(write_persistent_values_callback());
 
 //----- command readers and parsers --------------------------------------------------//
 
diff --git a/g2core/cycle_feedhold.cpp b/g2core/cycle_feedhold.cpp
index 094e8dd7..ebb9d072 100644
--- a/g2core/cycle_feedhold.cpp
+++ b/g2core/cycle_feedhold.cpp
@@ -36,7 +36,7 @@
 #include "spindle.h"
 #include "coolant.h"
 #include "util.h"
-//#include "xio.h"        // DIAGNOSTIC
+#include "xio.h"
 
 //static void _start_feedhold(void);
 static void _start_cycle_restart(void);
@@ -406,6 +406,7 @@ static void _start_queue_flush()
 {
     // Don't initiate the queue until in HOLD state (this also means that runtime is idle)
     if ((cm1.queue_flush_state == QUEUE_FLUSH_REQUESTED) && (cm1.hold_state == FEEDHOLD_HOLD)) {
+        xio_flush_device(DEV_IS_DATA);
         if (cm1.hold_type == FEEDHOLD_TYPE_ACTIONS) {
             op.add_action(_feedhold_restart_with_actions);
         } else {