From d60f78be71fd705cb6bbea8ecb5b5c49858c973e Mon Sep 17 00:00:00 2001
From: Shlomo Hecht <shlomo@twine-s.com>
Date: Thu, 10 May 2018 13:57:03 +0300
Subject: change motors config, improve initialization and control, first
 control run

---
 Software/Embedded_SW/Embedded/Modules/Thread/Thread_init.c | 12 ++----------
 1 file changed, 2 insertions(+), 10 deletions(-)

(limited to 'Software/Embedded_SW/Embedded/Modules/Thread/Thread_init.c')

diff --git a/Software/Embedded_SW/Embedded/Modules/Thread/Thread_init.c b/Software/Embedded_SW/Embedded/Modules/Thread/Thread_init.c
index 5a8c3df76..0e276fe92 100644
--- a/Software/Embedded_SW/Embedded/Modules/Thread/Thread_init.c
+++ b/Software/Embedded_SW/Embedded/Modules/Thread/Thread_init.c
@@ -51,7 +51,6 @@ uint32_t MotorsConfigMessage(HardwareMotor * request)
 {
     uint32_t status = PASSED;
     TimerMotors_t Motor_i;
-    MotorDriverConfigStruc MotorDriverConfig;
     Motor_i = request->hardwaremotortype;
     /*for (i=0;i<MAX_THREAD_MOTORS_NUM;i++)
     {
@@ -69,15 +68,8 @@ uint32_t MotorsConfigMessage(HardwareMotor * request)
     //if (Motor_i< MAX_THREAD_MOTORS_NUM)
     //{
         memcpy (&MotorsCfg[Motor_i],request,sizeof(HardwareMotor));
-        MotorDriverConfig.ACC = MotorsCfg[Motor_i].maxchangeslope;
-        MotorDriverConfig.DEC = MotorsCfg[Motor_i].maxchangeslope;
-        MotorDriverConfig.MaxSpeed = MotorsCfg[Motor_i].maxfrequency;
-        MotorDriverConfig.HasMicroStep = MotorsCfg[Motor_i].has_microstep;
-        MotorDriverConfig.Microstep = MotorsCfg[Motor_i].microstep;
-        MotorDriverConfig.HasConfigWord = MotorsCfg[Motor_i].has_configword;
-        MotorDriverConfig.ConfigWord = MotorsCfg[Motor_i].configword;
-
-        status = MotorConfig( Motor_i,  &MotorDriverConfig);
+
+        status = MotorConfig( Motor_i,  &MotorsCfg[Motor_i]);
 //        if (Motor_i == MOTOR_RDRIVING)
 //            ThreadInitialTestStub(request);
 
-- 
cgit v1.3.1