From bf40bcd56869d8007fcd0ba59cdd2f99210c3a60 Mon Sep 17 00:00:00 2001
From: =?UTF-8?q?King=20K=C3=A9vin?= <kingkevin@cuvoodoo.info>
Date: Sat, 14 Apr 2018 12:59:44 +0200
Subject: [PATCH] continue readind TMC data when more is expected

---
 tmc_dev.c | 11 +++++++++++
 1 file changed, 11 insertions(+)

diff --git a/tmc_dev.c b/tmc_dev.c
index df314a7..8e783e6 100644
--- a/tmc_dev.c
+++ b/tmc_dev.c
@@ -272,6 +272,17 @@ int tmcdev_read(struct tmcdev *dev)
 
   size2 = atoi(blockhdr + 2);
 
+  while(size < size2 && size<MAX_RESP_LEN) // we did not get all the data
+  {
+    ssize_t read_size = read(dev->fd, &dev->hdrbuf[size], MAX_RESP_LEN-size);
+    if(read_size < 1) // timeout or error occurred
+    {
+      blockhdr[31] = 0;
+      return -1;
+    }
+    size += read_size;
+  }
+
   size--;  // remove the last character
 
   if(size < size2)