From c8807df7010acb129997cb7ca130e6b7928ce809 Mon Sep 17 00:00:00 2001
From: Shlomo Hecht <shlomo@twine-s.com>
Date: Sun, 8 Jul 2018 09:44:28 +0300
Subject: reports in dancer control

---
 Software/Embedded_SW/Embedded/Modules/Thread/Thread_print.c | 8 ++++++++
 1 file changed, 8 insertions(+)

(limited to 'Software/Embedded_SW/Embedded/Modules/Thread')

diff --git a/Software/Embedded_SW/Embedded/Modules/Thread/Thread_print.c b/Software/Embedded_SW/Embedded/Modules/Thread/Thread_print.c
index 6740d6304..cfff7773b 100644
--- a/Software/Embedded_SW/Embedded/Modules/Thread/Thread_print.c
+++ b/Software/Embedded_SW/Embedded/Modules/Thread/Thread_print.c
@@ -286,7 +286,15 @@ uint32_t ThreadControlCBFunction(uint32_t IfIndex, uint32_t ReadValue)
     {
         DancerId = ThreadMotorIdToDancerId[index];
         if (ReadValue < 10)
+        {
+            REPORT_MSG(ReadValue, "Dancer value read too small.");
             return OK;
+        }
+        if (ReadValue == 0x3FFF)
+        {
+            LOG_ERROR(index, "Dancer value invalid.");
+            return OK;
+        }
         TranslatedReadValue = ReadValue - DancersCfg[DancerId].zeropoint;
         if (index == POOLER_MOTOR)
         {
-- 
cgit v1.3.1