Better fix for model backups import

companion/src/file.cpp

@@ -344,75 +344,55 @@ unsigned int RleFile::readRlc12(uint8_t *buf, unsigned int i_len, bool rlc2)
   }
 }
 
-unsigned int RleFile::importRlc2(QByteArray & dst, QByteArray & src)
+unsigned int importRlc(QByteArray & dst, QByteArray & src, unsigned int rlcVersion)
 {
-  // TODO reset dst
+  uint8_t *buf = (uint8_t *)src.data();
+  unsigned int len = src.size();
+  uint8_t zeroes = 0;
+  uint8_t bRlc = 0;
 
-  unsigned int i_len = src.size();
-  unsigned int i_ofs = 0;
-  uint8_t *buf = (uint8_t *)dst.data();
-  m_pos      = 0;
-  m_ofs      = 0;
-  m_zeroes   = 0;
-  m_bRlc     = 0;
-  m_err      = ERR_NONE;       //error reasons
+  dst.resize(0);
 
+  for( ; 1; ) {
+    for (int i=0; i<zeroes; i++)
+      dst.append((char)0);
+    zeroes = 0;
 
-  if (IS_SKY9X(board)) {
-    int len = std::min((int)i_len, (int)m_size + (int)sizeof(t_eeprom_header) - (int)m_pos);
-    if (len > 0) {
-      eeprom_read_block(buf, (m_fileId << 12) + m_pos, len);
-      m_pos += len;
+    if (len == 0)
+      return dst.size();
+
+    for (int i=0; i<bRlc; i++) {
+      dst.append(*buf++);
+      if (--len == 0)
+        return dst.size();
     }
-    return len;
-  }
-  else {
-    unsigned int i=0;
-    for( ; 1; ) {
-      uint8_t ln = std::min<uint16_t>(m_zeroes, i_len-i);
-      memset(&buf[i], 0, ln);
-      i        += ln;
-      m_zeroes -= ln;
-      if(m_zeroes) break;
 
-      ln = std::min<uint16_t>(m_bRlc, i_len-i);
-      memcpy(&buf[i], ((uint8_t *)src.data()) + i_ofs, ln);
-      i_ofs += ln;
-      uint8_t lr = ln;
+    bRlc = *buf++;
+    --len;
 
-      i        += lr ;
-      m_bRlc   -= lr;
-      if(m_bRlc) break;
+    if (!(bRlc & 0x7f)) {
+      qDebug() << "RLC decoding error!";
+      return 0;
+    }
 
-      // if (read(&m_bRlc, 1) !=1) break; //read how many bytes to read
-      m_bRlc = *(((uint8_t *)src.data()) + i_ofs);
-      i_ofs += 1;
-
-      if (!(m_bRlc & 0x7f)) {
-        qDebug() << "RLC decoding error!";
-        return 0;
+    if (rlcVersion == 2) {
+      if (bRlc&0x80){ // if contains high byte
+        zeroes  = (bRlc>>4) & 0x07;
+        bRlc    = bRlc & 0x0f;
       }
-
-      if (1/*rlc2*/) {
-        if(m_bRlc&0x80){ // if contains high byte
-          m_zeroes  =(m_bRlc>>4) & 0x7;
-          m_bRlc    = m_bRlc & 0x0f;
-        }
-        else if(m_bRlc&0x40){
-          m_zeroes  = m_bRlc & 0x3f;
-          m_bRlc    = 0;
-        }
-        //else   m_bRlc
+      else if (bRlc&0x40){
+        zeroes = bRlc & 0x3f;
+        bRlc   = 0;
       }
-      else {
-        if(m_bRlc&0x80){ // if contains high byte
-          m_zeroes  = m_bRlc & 0x7f;
-          m_bRlc    = 0;
-        }
+    }
+    else {
+      if (bRlc&0x80){ // if contains high byte
+        zeroes = bRlc & 0x7f;
+        bRlc   = 0;
       }
     }
-    return i;
   }
+  return dst.size();
 }
 
 unsigned int RleFile::write1(uint8_t b)