From f0fc1abe6628c903d2e58dcd1b1a88ef43d45057 Mon Sep 17 00:00:00 2001
From: Avi Levkovich <avi@twine-s.com>
Date: Tue, 26 May 2020 16:58:56 +0300
Subject: add the function test_dancer_responce_RTFU . in order to use it
 unmark the define test_RTFU_dancer stub :
 stubManager.Run<ProgressResponse>("ProgressRequest" ,0xdace, 1);// triger,
 direction 0 or 1

---
 .../Embedded/Modules/Control/MillisecTask.c            | 12 +++++++++---
 .../Embedded/Modules/Control/MillisecTask.h            |  2 ++
 .../Embedded/Modules/Stubs_Handler/Progress.c          | 18 ++++++++++++++++++
 3 files changed, 29 insertions(+), 3 deletions(-)

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

diff --git a/Software/Embedded_SW/Embedded/Modules/Control/MillisecTask.c b/Software/Embedded_SW/Embedded/Modules/Control/MillisecTask.c
index dfd01cef5..e2e006ba6 100644
--- a/Software/Embedded_SW/Embedded/Modules/Control/MillisecTask.c
+++ b/Software/Embedded_SW/Embedded/Modules/Control/MillisecTask.c
@@ -490,9 +490,15 @@ uint32_t MillisecLoop(uint32_t tick)
 #ifdef HUNDRED_MICROSECONDS_DANCER_READ
    SaveLogData();
 #else
-    Dancer_Data[FEEDER_DANCER] = Read_Dancer_Position(FEEDER_DANCER);
-    Dancer_Data[POOLER_DANCER] = Read_Dancer_Position(POOLER_DANCER);
-    Dancer_Data[WINDER_DANCER] = Read_Dancer_Position(WINDER_DANCER);
+
+    #ifdef test_RTFU_dancer
+       test_dancer_responce_RTFU();
+    #else
+        Dancer_Data[FEEDER_DANCER] = Read_Dancer_Position(FEEDER_DANCER);
+        Dancer_Data[POOLER_DANCER] = Read_Dancer_Position(POOLER_DANCER);
+        Dancer_Data[WINDER_DANCER] = Read_Dancer_Position(WINDER_DANCER);
+    #endif
+
 #endif
     return OK;
 }
diff --git a/Software/Embedded_SW/Embedded/Modules/Control/MillisecTask.h b/Software/Embedded_SW/Embedded/Modules/Control/MillisecTask.h
index 9335a6d08..25336f50c 100644
--- a/Software/Embedded_SW/Embedded/Modules/Control/MillisecTask.h
+++ b/Software/Embedded_SW/Embedded/Modules/Control/MillisecTask.h
@@ -52,5 +52,7 @@ void MillisecLogClose(void);
 
 extern bool watchdogCriticalAlarm;
 
+extern uint32_t        Millisec_timerBase;
+
 extern Task_Handle Millisecond_Task_Handle;
 #endif /* MODULES_CONTROL_MILLISECTASK_H_ */
diff --git a/Software/Embedded_SW/Embedded/Modules/Stubs_Handler/Progress.c b/Software/Embedded_SW/Embedded/Modules/Stubs_Handler/Progress.c
index fff8596f8..30067afa9 100644
--- a/Software/Embedded_SW/Embedded/Modules/Stubs_Handler/Progress.c
+++ b/Software/Embedded_SW/Embedded/Modules/Stubs_Handler/Progress.c
@@ -85,6 +85,24 @@ void Stub_ProgressRequest(MessageContainer* requestContainer)
         response.progress = Test_Uart3(request->delay);
         response.has_progress = true;
     }
+    else
+    if(request->amount == 0xdace)//test_dancer_responce_RTFU
+    {
+        test_dancer_flag = true;
+
+        if(request->delay == 0x01)
+        {
+            test_dancer_direction  = true;
+        }
+        else
+        if(request->delay == 0x00)
+        {
+            test_dancer_direction  = false;
+        }
+
+        response.progress = 0xdace;
+        response.has_progress = true;
+    }
     else
         if(request->amount == 0x3EC)
         {
-- 
cgit v1.3.1