Merge branch 'master' of https://twinetfs.visualstudio.com/_git/Tango

1 files changed, 7 insertions, 2 deletions

diff --git a/Software/Embedded_SW/Embedded/Modules/Thread/Thread_print.c b/Software/Embedded_SW/Embedded/Modules/Thread/Thread_print.c
index 434ac0f21..92939dfe4 100644
--- a/Software/Embedded_SW/Embedded/Modules/Thread/Thread_print.c
+++ b/Software/Embedded_SW/Embedded/Modules/Thread/Thread_print.c
@@ -281,7 +281,7 @@ bool InitialProcess = false;
 
             MotorSetDirection((TimerMotors_t)HW_Motor_Id,MotorsCfg[HW_Motor_Id].directionthreadwize);
     #ifdef DEBUG_TEST_FUNCTIONS
-
+/*
             if (Motor_i == FEEDER_MOTOR) // dryer motor is speed controlled. later a speed sensor will be utilized, but for now it will not be controlled
                 ControlIdtoMotorId[Motor_i] = AddControlCallback(ThreadLengthCBFunction, eOneMillisecond,MotorGetPositionFromFPGA,(IfTypeThread*0x100+Motor_i),ThreadMotorIdToDancerId[Motor_i],Motor_i);
             if (Motor_i == POOLER_MOTOR) // dryer motor is speed controlled. later a speed sensor will be utilized, but for now it will not be controlled
@@ -315,7 +315,7 @@ uint32_t ThreadPreSegmentState(void *JobDetails)
 
     int process_speed = JobTicket->processparameters->dyeingspeed;
 
-    process_speed = 10; //debug
+    process_speed = 50; //debug
 
     for (Motor_i = 0;Motor_i <= WINDER_MOTOR;Motor_i++)
     {
@@ -328,6 +328,11 @@ uint32_t ThreadPreSegmentState(void *JobDetails)
     //ControlStart();
     // set the new speed in the dryer motor to the speed of the new segment
     MotorSetSpeed(HARDWARE_MOTOR_TYPE__MOTO_DRYER_DRIVING, OriginalMotorSpd_2PPS[DRYER_MOTOR],  MotorsCfg[HARDWARE_MOTOR_TYPE__MOTO_DRYER_DRIVING].microstep);
+ //only for testing - when control works, these motors will take their speed from the dryer
+    MotorSetSpeed(HARDWARE_MOTOR_TYPE__MOTO_LDRIVING, OriginalMotorSpd_2PPS[POOLER_MOTOR],  MotorsCfg[HARDWARE_MOTOR_TYPE__MOTO_LDRIVING].microstep);
+ //only for testing - when control works, these motors will take their speed from the dryer
+    MotorSetSpeed(HARDWARE_MOTOR_TYPE__MOTO_RDRIVING, OriginalMotorSpd_2PPS[FEEDER_MOTOR],  MotorsCfg[HARDWARE_MOTOR_TYPE__MOTO_RDRIVING].microstep);
+
     MotorSetSpeed(HARDWARE_MOTOR_TYPE__MOTO_RLOADING, 1, 1);
     MotorSetSpeed(HARDWARE_MOTOR_TYPE__MOTO_LLOADING, 1,1);