From 24bc115a26162cb88fa3c9c44bd7cb1e68d1b749 Mon Sep 17 00:00:00 2001
From: Mark Watkins <jedimark@users.sourceforge.net>
Date: Mon, 7 Jul 2014 03:40:09 +1000
Subject: [PATCH] Resolve CMS50E corrupted record hedaer condition

---
 .../SleepLib/loader_plugins/cms50_loader.cpp  | 30 ++++++++++++++-----
 1 file changed, 22 insertions(+), 8 deletions(-)

diff --git a/sleepyhead/SleepLib/loader_plugins/cms50_loader.cpp b/sleepyhead/SleepLib/loader_plugins/cms50_loader.cpp
index 8c2bfb80..9ee13929 100644
--- a/sleepyhead/SleepLib/loader_plugins/cms50_loader.cpp
+++ b/sleepyhead/SleepLib/loader_plugins/cms50_loader.cpp
@@ -347,14 +347,28 @@ int CMS50Loader::doImportMode()
             } else if (!started_reading) { // have not got a valid trio yet, skip...
                 idx += 1;
             } else {
-                //Completed
-                finished_import = true;
-                killTimers();
-                m_importing = false;
-                m_status = NEUTRAL;
-                emit importComplete(this);
-                resetTimer.singleShot(2000, this, SLOT(shutdownPorts()));
-                return available;
+                // scan ahead for another 0xf0 in case it's corrupted..
+                bool resync = false;
+
+                for (int i=idx; i < available; ++i) {
+                    c=(unsigned char)buffer.at(i);
+                    if ((c & 0xf0) == 0xf0) {
+                        idx = i;
+                        resync = true;
+                        break;
+                    }
+                }
+
+                if (!resync) {
+                    // Data transfer has completed
+                    finished_import = true;
+                    killTimers();
+                    m_importing = false;
+                    m_status = NEUTRAL;
+                    emit importComplete(this);
+                    resetTimer.singleShot(2000, this, SLOT(shutdownPorts()));
+                    return available;
+                }
             }
         }
     }