aboutsummaryrefslogtreecommitdiffstats
path: root/Software/Embedded_SW/Embedded/Modules
diff options
context:
space:
mode:
authorRoy Ben Shabat <Roy.mail.net@gmail.com>2020-09-23 15:47:43 +0300
committerRoy Ben Shabat <Roy.mail.net@gmail.com>2020-09-23 15:47:43 +0300
commitebab135a34ab5d44aaf9588e3eedd4e4f24db2ce (patch)
tree8f8991661b3194b0dd3de9e9fd30d752d5350797 /Software/Embedded_SW/Embedded/Modules
parent1a0bf1711a8736f8c100c5053de6cfc54bfe2b93 (diff)
parent2faf5e3e5183ab717e28209cd62959d94cd7a073 (diff)
downloadTango-ebab135a34ab5d44aaf9588e3eedd4e4f24db2ce.tar.gz
Tango-ebab135a34ab5d44aaf9588e3eedd4e4f24db2ce.zip
Merge branch 'master' of https://twinetfs.visualstudio.com/Tango/_git/Tango
Diffstat (limited to 'Software/Embedded_SW/Embedded/Modules')
-rw-r--r--Software/Embedded_SW/Embedded/Modules/AlarmHandling/AlarmHandling.c2
-rw-r--r--Software/Embedded_SW/Embedded/Modules/Heaters/Heaters_print.c13
-rw-r--r--Software/Embedded_SW/Embedded/Modules/IDS/IDS_Cleaning.c75
-rw-r--r--Software/Embedded_SW/Embedded/Modules/IDS/IDS_ex.h1
-rw-r--r--Software/Embedded_SW/Embedded/Modules/IDS/IDS_print.c13
-rw-r--r--Software/Embedded_SW/Embedded/Modules/Stubs_Handler/Progress.c23
-rw-r--r--Software/Embedded_SW/Embedded/Modules/Thread/ThreadLoad.c4
7 files changed, 90 insertions, 41 deletions
diff --git a/Software/Embedded_SW/Embedded/Modules/AlarmHandling/AlarmHandling.c b/Software/Embedded_SW/Embedded/Modules/AlarmHandling/AlarmHandling.c
index 78398119b..b5c24835a 100644
--- a/Software/Embedded_SW/Embedded/Modules/AlarmHandling/AlarmHandling.c
+++ b/Software/Embedded_SW/Embedded/Modules/AlarmHandling/AlarmHandling.c
@@ -835,7 +835,7 @@ JobEndReasonEnum AlarmHandlingPrepareJob(void *CurrentJob)
if (n_segments == 0)
{
ReportWithPackageFilter(AlarmFilter,"no segments in the job", __FILE__,__LINE__,0, DEBUG_LOG_CATEGORY__Warning, 222, 0);
- return JOB_OK;
+ return JOB_FILE_PROBLEM;
}
if (AlarmItem == NULL)
{
diff --git a/Software/Embedded_SW/Embedded/Modules/Heaters/Heaters_print.c b/Software/Embedded_SW/Embedded/Modules/Heaters/Heaters_print.c
index 454c9e064..3cadd407c 100644
--- a/Software/Embedded_SW/Embedded/Modules/Heaters/Heaters_print.c
+++ b/Software/Embedded_SW/Embedded/Modules/Heaters/Heaters_print.c
@@ -229,8 +229,8 @@ void initializeArrays(void)
HeaterId2PT100Id[HEATER_TYPE__HeaterZone11] = HEAD_PT100_ZONE_11_0X8A_0;
HeaterId2PT100Id[HEATER_TYPE__HeaterZone12] = HEAD_PT100_ZONE_12_0X8A_1;
*/
- HeaterId2PT100Id[HEATER_TYPE__HeadCoverHeater1] = HEAD_PT100_ZONE_11_0X8A_0;
- HeaterId2PT100Id[HEATER_TYPE__HeadCoverHeater2] = HEAD_PT100_ZONE_12_0X8A_1;
+ HeaterId2PT100Id[HEATER_TYPE__HeadCoverHeater1] = HEAD_PT100_AIR_HEATER_2_0X8C_1;//HEAD_PT100_ZONE_11_0X8A_0;
+ HeaterId2PT100Id[HEATER_TYPE__HeadCoverHeater2] = HEAD_PT100_AIR_HEATER_1_0X8C_0 ;//HEAD_PT100_ZONE_12_0X8A_1;
HeaterId2CurrentId[HEATER_TYPE__DryerAirHeater] = NUM_OF_CURRENT_HEATERS;
HeaterId2CurrentId[HEATER_TYPE__DryerMainHeater] = HEATER_DRYER_CURRENT_1;
@@ -400,12 +400,12 @@ uint32_t HeatersTestInternalAlarmsCBFunction(uint32_t IfIndex, uint32_t readValu
{
if (InternalAlarmActive[index] == false)
{
- if(InternalOverHeatCounter[index]++ >=Overheat_Count_Limit)
+ ReportWithPackageFilter(HeatersFilter,"Internal Over the max temperature",__FILE__,index,readValue,RpWarning, InternalOverHeatCounter[index],0);
+ if(InternalOverHeatCounter[index]++ >=Overheat_Count_Limit*10)
{
InternalOverHeatCounter[index] = Overheat_Count_Limit;
InternalAlarmActive[index] = true;
- ReportWithPackageFilter(HeatersFilter,"Internal Over the max temperature, heater turned off",__FILE__,index,readValue,RpWarning, 0,0);
AlarmHandlingSetAlarm(InternalTempEventType[index], true);
if (JobIsActive())
{
@@ -424,11 +424,12 @@ uint32_t HeatersTestInternalAlarmsCBFunction(uint32_t IfIndex, uint32_t readValu
{
if (InternalAlarmActive[index] == true)
{
+ ReportWithPackageFilter(HeatersFilter,"Internal Under the max temperature",__FILE__,index,readValue,RpWarning, InternalOverHeatCounter[index],0);
if(InternalOverHeatCounter[index]-- <= 0)
{
InternalOverHeatCounter[index] = 0;
- InternalAlarmActive[index] = true;
+ InternalAlarmActive[index] = false;
ReportWithPackageFilter(HeatersFilter,"Internal Under the max temperature, alarm turned off",__FILE__,index,readValue,RpWarning, 0,0);
AlarmHandlingSetAlarm(InternalTempEventType[index], false);
}
@@ -1301,7 +1302,7 @@ uint32_t HeaterControlCBFunction(uint32_t IfIndex, uint32_t readValue)
{
if ((HeaterMaxTempFlag[HEATER_TYPE__DryerSecondaryHeater] == false)&&(HeaterMaxTempFlag[HEATER_TYPE__DryerMainHeater] == false))
{
- ReportWithPackageFilter(HeatersFilter,"AC Activating",__FILE__,index,HeaterPreviousRead[index],RpWarning,readValue, index);
+ //ReportWithPackageFilter(HeatersFilter,"AC Activating",__FILE__,index,HeaterPreviousRead[index],RpWarning,readValue, index);
ActivateHeater(HEATER_TYPE__DryerSecondaryHeater);
ActivateHeater(HEATER_TYPE__DryerMainHeater);
HeaterRecalculateSharedHeatersParams(HEATER_TYPE__DryerMainHeater,100);
diff --git a/Software/Embedded_SW/Embedded/Modules/IDS/IDS_Cleaning.c b/Software/Embedded_SW/Embedded/Modules/IDS/IDS_Cleaning.c
index 256d25aa5..51294b1a2 100644
--- a/Software/Embedded_SW/Embedded/Modules/IDS/IDS_Cleaning.c
+++ b/Software/Embedded_SW/Embedded/Modules/IDS/IDS_Cleaning.c
@@ -28,6 +28,7 @@ typedef enum
CleaningStageActuatorDown,
CleaningStageDelay2,
}CleaningStageEnum;
+TimerMotors_t MotorId = HARDWARE_MOTOR_TYPE__MOTO_DH_LID;
/*
*Cleaning sequence:
@@ -51,42 +52,55 @@ int CleaningStageCounter = 8;//Tdelay1 - 1 to start with stage moving down
void Init_CleaningStageCounter()
{
- CleaningStageCounter = Tdelay1 - 1;
+ if(Head_Type == HEAD_TYPE_FLAT) {
+ CleaningStageCounter = Tdelay1 - 1;
+ } else {
+ CleaningStageCounter = 0;
+ }
+}
+
+uint32_t cleaningMotorCBFunction (uint32_t deviceID, uint32_t Parameter1)
+{
+ CleaningStageCounter = 0;
+ return 0;
}
uint32_t IDS_Cleaning_Move_Actuators()
{
- if(Head_Type != HEAD_TYPE_FLAT)
+ if((Head_Type != HEAD_TYPE_FLAT) && (Head_Type != HEAD_TYPE_ARC))
return OK;
- if (CleaningStageCounter == 1)
- {
- Trigger_Head_Actuators_Stub(ACTIN, ENABLE, UP);
- //Trigger_Head_Actuators_Control(ACTIN, LOW,true);
- ReportWithPackageFilter(IDSFilter,"IDS_Cleaning_Move_ActuatorUp", __FILE__, __LINE__, 1, RpWarning, CleaningStageCounter, 0);
- }
- else if (CleaningStageCounter == Tup)
- {
- Trigger_Head_Actuators_Stub(ACTIN, DISABLE, DONTCARE);
- //Trigger_Head_Actuators_Disable();
- ReportWithPackageFilter(IDSFilter,"IDS_Cleaning_Stop_Actuator", __FILE__, __LINE__, Tup, RpWarning, CleaningStageCounter, 0);
- }
- else if (CleaningStageCounter == Tdelay1)
- {
- Trigger_Head_Actuators_Stub(ACTIN, ENABLE, DOWN);
- //Trigger_Head_Actuators_Control(ACTIN, LOW,false);
- ReportWithPackageFilter(IDSFilter,"IDS_Cleaning_MoveDown", __FILE__, __LINE__, Tdelay1, RpWarning, CleaningStageCounter, 0);
+ if(Head_Type == HEAD_TYPE_FLAT) {
+ if (CleaningStageCounter == 1)
+ {
+ Trigger_Head_Actuators_Stub(ACTIN, ENABLE, UP);
+ //Trigger_Head_Actuators_Control(ACTIN, LOW,true);
+ ReportWithPackageFilter(IDSFilter,"IDS_Cleaning_Move_ActuatorUp", __FILE__, __LINE__, 1, RpWarning, CleaningStageCounter, 0);
+ }
+ else if (CleaningStageCounter == Tup)
+ {
+ Trigger_Head_Actuators_Stub(ACTIN, DISABLE, DONTCARE);
+ //Trigger_Head_Actuators_Disable();
+ ReportWithPackageFilter(IDSFilter,"IDS_Cleaning_Stop_Actuator", __FILE__, __LINE__, Tup, RpWarning, CleaningStageCounter, 0);
+ }
+ else if (CleaningStageCounter == Tdelay1)
+ {
+ Trigger_Head_Actuators_Stub(ACTIN, ENABLE, DOWN);
+ //Trigger_Head_Actuators_Control(ACTIN, LOW,false);
+ ReportWithPackageFilter(IDSFilter,"IDS_Cleaning_MoveDown", __FILE__, __LINE__, Tdelay1, RpWarning, CleaningStageCounter, 0);
+ }
+ else if (CleaningStageCounter == Tdelay2)
+ {
+ CleaningStageCounter = 0;
+ Trigger_Head_Actuators_Stub(ACTIN, DISABLE, DONTCARE);
+ ReportWithPackageFilter(IDSFilter,"IDS_Cleaning_Stop_delay", __FILE__, __LINE__, Tdelay2, RpWarning, CleaningStageCounter, 0);
+ }
+ } else { //arc
+ if (CleaningStageCounter == 0) {
+ MotorSetSpeed(MotorId, 1000);
+ ReportWithPackageFilter(IDSFilter,"IDS_Cleaning_Motor_Run", __FILE__, __LINE__, 1, RpWarning, CleaningStageCounter, 0);
+ }
}
- else if (CleaningStageCounter == Tdelay2)
- {
- CleaningStageCounter = 0;
- Trigger_Head_Actuators_Stub(ACTIN, DISABLE, DONTCARE);
- ReportWithPackageFilter(IDSFilter,"IDS_Cleaning_Stop_delay", __FILE__, __LINE__, Tdelay2, RpWarning, CleaningStageCounter, 0);
- }
-
-
-
CleaningStageCounter++;
-
return OK;
}
/*uint32_t IDS_Cleaning_Move_Rockers (int LeftRockerSpeed,int RightRockerSpeed)
@@ -137,6 +151,9 @@ uint32_t IDS_Cleaning_Stop_Cleaning_Solution (callback_fptr callback)
ReportWithPackageFilter(IDSFilter,"IDS_Cleaning_Stop_Cleaning_Solution", __FILE__, __LINE__, CLEANER_DISPENSER, RpWarning, status, 0);
HeadCard_Actuators_Relocate();
Init_CleaningStageCounter();
+ MotorStop(MotorId,Hard_Hiz);
+ MotorMovetoLimitSwitch(MotorId,1-MotorsCfg[MotorId].directionthreadwize, 50, Motor_Id_to_LS_IdDown[MotorId], cleaningMotorCBFunction,30000);
+ ReportWithPackageFilter(IDSFilter,"IDS_Cleaning_Motor_Homing", __FILE__, __LINE__, 1, RpWarning, CleaningStageCounter, 0);
CleaningStage = CleaningStageIdle;
ReportWithPackageFilter(IDSFilter,"IDS_Cleaning_Stop_Cleaning_Solution actuator relocate", __FILE__, __LINE__, CleaningStage, RpWarning, CleaningStageCounter, 0);
diff --git a/Software/Embedded_SW/Embedded/Modules/IDS/IDS_ex.h b/Software/Embedded_SW/Embedded/Modules/IDS/IDS_ex.h
index 9973e4c7c..57d3ff5e2 100644
--- a/Software/Embedded_SW/Embedded/Modules/IDS/IDS_ex.h
+++ b/Software/Embedded_SW/Embedded/Modules/IDS/IDS_ex.h
@@ -117,5 +117,6 @@ void DispenserDataRequestFunc(MessageContainer* requestContainer);
void IDS_Start_Pid_Testing(int DispenserId);
void IDS_Stop_Pid_Testing(int DispenserId);
+uint32_t cleaningMotorCBFunction (uint32_t deviceID, uint32_t Parameter1);
#endif /* MODULES_IDS_IDS_EX_H_ */
diff --git a/Software/Embedded_SW/Embedded/Modules/IDS/IDS_print.c b/Software/Embedded_SW/Embedded/Modules/IDS/IDS_print.c
index d40f3c00b..d508c2ed2 100644
--- a/Software/Embedded_SW/Embedded/Modules/IDS/IDS_print.c
+++ b/Software/Embedded_SW/Embedded/Modules/IDS/IDS_print.c
@@ -348,6 +348,11 @@ JobDescriptionFileBrushStop *FirstBrushStop = NULL;
FreeSegmentFileData(Segment);
CloseJobFile();
}
+ else
+ {
+ ReportWithPackageFilter(IDSFilter,"Error Opening the file", __FILE__, __LINE__, Fresult, RpWarning, 0, 0);
+ return false;
+ }
//GeneralHwReady = true;
int ActiveDispensers = 0;
for (Dispenser_i = 0; Dispenser_i < MAX_DYE_DISPENSERS; Dispenser_i++)
@@ -529,7 +534,7 @@ bool AdjustDispenserSpeedToPressure(int DispenserId, double RefMaxPressure,doubl
updatedSpeed = tempSpeed*0.98;
MotorSetSpeed(HW_Motor_Id, updatedSpeed);
CurrentDispenserSpeed[DispenserId] = updatedSpeed;
- ReportWithPackageFilter(IDSFilter,"IDS decrease speed",__FILE__,DispenserId,(int)updatedSpeed,RpWarning,(int)(pressure*100),0);
+ //ReportWithPackageFilter(IDSFilter,"IDS decrease speed",__FILE__,DispenserId,(int)updatedSpeed,RpWarning,(int)(pressure*100),0);
//return true; //ready
}
else if (pressure < RefMaxPressure*0.97)
@@ -539,7 +544,7 @@ bool AdjustDispenserSpeedToPressure(int DispenserId, double RefMaxPressure,doubl
updatedSpeed = (tempSpeed * 1.02 < InitialDispenserSpeed) ? tempSpeed * 1.02 : InitialDispenserSpeed;
MotorSetSpeed(HW_Motor_Id, updatedSpeed);
CurrentDispenserSpeed[DispenserId] = updatedSpeed;
- ReportWithPackageFilter(IDSFilter,"IDS increase speed",__FILE__,DispenserId,(int)updatedSpeed,RpWarning,(int)(pressure*100),0);
+ //ReportWithPackageFilter(IDSFilter,"IDS increase speed",__FILE__,DispenserId,(int)updatedSpeed,RpWarning,(int)(pressure*100),0);
//return false; //not ready
}
if ((pressure>RefMaxPressure)&&(pressure<(RefMaxPressure+0.1)))
@@ -599,7 +604,7 @@ bool AdjustDispenserSpeedToPressure(int DispenserId, double RefMaxPressure,doubl
if (AdjustDispenserSpeedToPressure(i,DispenserPreparePressure,pressure) == true)
NumofReadyDispensers++;
}
- ReportWithPackageFilter(IDSFilter,"IDS prepare",__FILE__,i,(int)DispenserTotalPrepareSteps[i],RpWarning,(int)(CurrentDispenserSpeed[i]*100),0);
+ //ReportWithPackageFilter(IDSFilter,"IDS prepare",__FILE__,i,(int)DispenserTotalPrepareSteps[i],RpWarning,(int)(CurrentDispenserSpeed[i]*100),0);
}
}
pressure = GetDispenserPressure(CLEANER_DISPENSER);
@@ -1312,7 +1317,7 @@ uint32_t IDSPreSegmentState(void *SegmentDetails, int SegmentId)
/* wait for all dispensers to get to the required pressure
* move the presegment ready when all dispensers are ready.
*/
- REPORT_MSG(Segment->n_brushstops,"IDSPreSegmentState");
+ ReportWithPackageFilter(IDSFilter,"IDSPreSegmentState",__FILE__,__LINE__,(int)Segment->n_brushstops,RpError,(int)SegmentId,0);
if (JobBrushStopId>=Segment->n_brushstops)
{
ReportWithPackageFilter(IDSFilter,"Error JobBrushStopId",__FILE__,__LINE__,(int)Segment->n_brushstops,RpError,(int)0,0);
diff --git a/Software/Embedded_SW/Embedded/Modules/Stubs_Handler/Progress.c b/Software/Embedded_SW/Embedded/Modules/Stubs_Handler/Progress.c
index 5da52f590..008b49211 100644
--- a/Software/Embedded_SW/Embedded/Modules/Stubs_Handler/Progress.c
+++ b/Software/Embedded_SW/Embedded/Modules/Stubs_Handler/Progress.c
@@ -28,6 +28,7 @@
#include "drivers/FPGA/FPGA_SPI_Comm.h"
#include "Modules/IFS/ifs.h"
#include "Modules/IDS/ids_ex.h"
+#include "Modules/IDS/ids.h"
#include "Modules/Control/MillisecTask.h"
#include "modules/thread/thread_ex.h"
#include "modules/heaters/heaters_ex.h"
@@ -1142,6 +1143,28 @@ void Stub_ProgressRequest(MessageContainer* requestContainer)
response.has_progress = true;
}
else
+ if(request->amount == 0xB14)
+ {
+ LOG_ERROR(request->amount,"IDS_Cleaning_Move_Actuators");
+ Init_CleaningStageCounter();
+ IDS_Cleaning_Move_Actuators();
+
+ response.progress = 0xB14;
+ response.has_progress = true;
+ }
+ else
+ if(request->amount == 0xB15)
+ {
+ TimerMotors_t MotorId = HARDWARE_MOTOR_TYPE__MOTO_DH_LID;
+ LOG_ERROR(request->amount,"MotorMovetoLimitSwitch");
+ MotorStop(MotorId,Hard_Hiz);
+ MotorMovetoLimitSwitch(MotorId,1 - MotorsCfg[MotorId].directionthreadwize, 50, Motor_Id_to_LS_IdDown[MotorId], cleaningMotorCBFunction,30000);
+ ReportWithPackageFilter(IDSFilter,"IDS_Cleaning_Motor_Homing", __FILE__, __LINE__, 1, RpWarning, 0, 0);
+
+ response.progress = 0xB15;
+ response.has_progress = true;
+ }
+ else
if(request->amount == 0xC3) //suspend I2C task
{
if (request->delay == 0)
diff --git a/Software/Embedded_SW/Embedded/Modules/Thread/ThreadLoad.c b/Software/Embedded_SW/Embedded/Modules/Thread/ThreadLoad.c
index 554e4d1ef..d5c186893 100644
--- a/Software/Embedded_SW/Embedded/Modules/Thread/ThreadLoad.c
+++ b/Software/Embedded_SW/Embedded/Modules/Thread/ThreadLoad.c
@@ -1407,6 +1407,8 @@ uint32_t ThreadLoadingReport(void)
if (ThreadLoadingToken[0] == 0)
return OK;
+ if (LoadStages == THREAD_LOAD_INIT)
+ return OK;
if (MessageState == 0)
{
@@ -1485,7 +1487,7 @@ uint32_t ThreadLoadingRestartReport(void) //sending after a failure in the final
response.has_state = true;
response.state = THREAD_LOADING_STATE__ReadyForLoading;
response.errorreason = DefaultErrSrt;
- Report("ThreadLoadingReport",__FILE__,MessageState,response.state,RpWarning,(int)LoadStages,0);
+ Report("ThreadLoadingRestartReport",__FILE__,MessageState,response.state,RpWarning,(int)LoadStages,0);
//-------------------------------------------------------------------------------------------
responseContainer = createContainer(MESSAGE_TYPE__StartThreadLoadingResponse, ThreadLoadingToken, false, &response, &start_thread_loading_response__pack, &start_thread_loading_response__get_packed_size);
responseContainer.has_continuous = true;