using System;
|
using System.Collections.Generic;
|
|
namespace SHARP_CLAS_UI
|
{
|
public class LoaderReverseStage : ReverseStage
|
{
|
#region Enum
|
public enum StageSteps
|
{
|
S0000_WAIT,
|
|
S1000_PLACE_PRE_ALIGN_STAGE_START,
|
S1100_PRE_ALIGN_STAGE_VACUUM_ON,
|
S1110_VACUUM_OFF,
|
S1120_DATA_SET,
|
|
S9000_SCRAP_START,
|
S9100_VACUUM_OFF,
|
S9110_DATA_SET,
|
S9999_STEP_END,
|
}
|
#endregion
|
|
#region Property
|
public bool IsPlaceEnable
|
{
|
get
|
{
|
if(Step == LoaderReverseStageSteps.S1230_PANEL_EXIST_CHECK && IsStayPosition)
|
{
|
return true;
|
}
|
else
|
{
|
return false;
|
}
|
}
|
}
|
|
public override Panel_Info Panel1
|
{
|
get
|
{
|
return Panel_Info_Manager.Instance.Get_Panel_Info(Panel_Info_Names.LD_Reverse_Stage_1);
|
}
|
set
|
{
|
Panel_Info_Manager.Instance.Set_Panel_Info(Panel_Info_Names.LD_Reverse_Stage_1, value);
|
}
|
}
|
|
public override Panel_Info Panel2
|
{
|
get
|
{
|
return Panel_Info_Manager.Instance.Get_Panel_Info(Panel_Info_Names.LD_Reverse_Stage_2);
|
}
|
set
|
{
|
Panel_Info_Manager.Instance.Set_Panel_Info(Panel_Info_Names.LD_Reverse_Stage_2, value);
|
}
|
}
|
|
public LoaderReverseStageSteps Step
|
{
|
get
|
{
|
return _step;
|
}
|
|
set
|
{
|
_step = value;
|
}
|
}
|
|
public override bool IsWorkEnd
|
{
|
get
|
{
|
if(Step == LoaderReverseStageSteps.S0000_WAIT)
|
{
|
return true;
|
}
|
else
|
{
|
return false;
|
}
|
}
|
}
|
|
public override bool IsStayPosition
|
{
|
get
|
{
|
if (IsPositionR1Degree180 && IsPositionR2Degree180 && IsPositionZ1Down && IsPositionZ2Down)
|
{
|
return true;
|
}
|
else
|
{
|
return false;
|
}
|
}
|
}
|
|
public bool IsPositionZ1Up
|
{
|
get
|
{
|
object value;
|
double get_position;
|
|
equipment.sm.Get_Value(Position_Parameter_Address.LD_Reverse_Unit_1_Z_Up_Position, out value);
|
get_position = double.Parse($"{value}");
|
|
return MotorZ1.Is_Inposition(get_position, equipment.Setting.Inposition_Offset);
|
}
|
}
|
|
public bool IsPositionZ1Down
|
{
|
get
|
{
|
object value;
|
double get_position;
|
|
equipment.sm.Get_Value(Position_Parameter_Address.LD_Reverse_Unit_1_Z_Down_Position, out value);
|
get_position = double.Parse($"{value}");
|
|
return MotorZ1.Is_Inposition(get_position, equipment.Setting.Inposition_Offset);
|
}
|
}
|
|
public bool IsPositionR1Degree0
|
{
|
get
|
{
|
object value;
|
double get_position;
|
|
equipment.sm.Get_Value(Position_Parameter_Address.LD_Reverse_Unit_1_T_0_Position, out value);
|
get_position = double.Parse($"{value}");
|
|
return MotorR1.Is_Inposition(get_position, equipment.Setting.Inposition_Offset);
|
}
|
}
|
|
public bool IsPositionR1Degree180
|
{
|
get
|
{
|
object value;
|
double get_position;
|
|
equipment.sm.Get_Value(Position_Parameter_Address.LD_Reverse_Unit_1_T_180_Position, out value);
|
get_position = double.Parse($"{value}");
|
|
return MotorR1.Is_Inposition(get_position, equipment.Setting.Inposition_Offset);
|
}
|
}
|
|
public bool IsPositionZ2Up
|
{
|
get
|
{
|
object value;
|
double get_position;
|
|
equipment.sm.Get_Value(Position_Parameter_Address.LD_Reverse_Unit_2_Z_Up_Position, out value);
|
get_position = double.Parse($"{value}");
|
|
return MotorZ2.Is_Inposition(get_position, equipment.Setting.Inposition_Offset);
|
}
|
}
|
|
public bool IsPositionZ2Down
|
{
|
get
|
{
|
object value;
|
double get_position;
|
|
equipment.sm.Get_Value(Position_Parameter_Address.LD_Reverse_Unit_2_Z_Down_Position, out value);
|
get_position = double.Parse($"{value}");
|
|
return MotorZ2.Is_Inposition(get_position, equipment.Setting.Inposition_Offset);
|
}
|
}
|
|
public bool IsPositionR2Degree0
|
{
|
get
|
{
|
object value;
|
double get_position;
|
|
equipment.sm.Get_Value(Position_Parameter_Address.LD_Reverse_Unit_2_T_0_Position, out value);
|
get_position = double.Parse($"{value}");
|
|
return MotorR2.Is_Inposition(get_position, equipment.Setting.Inposition_Offset);
|
}
|
}
|
|
public bool IsPositionR2Degree180
|
{
|
get
|
{
|
object value;
|
double get_position;
|
|
equipment.sm.Get_Value(Position_Parameter_Address.LD_Reverse_Unit_2_T_180_Position, out value);
|
get_position = double.Parse($"{value}");
|
|
return MotorR2.Is_Inposition(get_position, equipment.Setting.Inposition_Offset);
|
}
|
}
|
|
#endregion
|
|
#region Field
|
private LoaderReverseStageSteps _step;
|
private LoaderReverseStageSteps _oldStep;
|
private ReverseStageHomeSteps _homeStep;
|
|
private StageSteps _stage1Step;
|
private StageSteps _stage2Step;
|
|
public SequenceTimer Tact_Move = new SequenceTimer();
|
#endregion
|
|
#region Construct
|
public LoaderReverseStage(Equipment equipment) : base(equipment, MotorAxis.LD_Rotation_Unit_Z_1, MotorAxis.LD_Rotation_Unit_R_1, MotorAxis.LD_Rotation_Unit_Z_2, MotorAxis.LD_Rotation_Unit_R_2, "LoaderReverseStage")
|
{
|
Step = LoaderReverseStageSteps.S0000_WAIT;
|
_oldStep = LoaderReverseStageSteps.S0000_WAIT;
|
|
Stage1.Initialize(OutputData.LD_Cell_Reverse_1_Vaccum_On_Sol_Valve, OutputData.LD_Cell_Reverse_1_Blow_On_Sol_Valve, InputData.LD_Cell_Reverse_1_Vaccum_On_Check, En_Alarm_List.AL_0660_LD_REVERSE_1_VACUUM_ON_CHECK);
|
Stage2.Initialize(OutputData.LD_Cell_Reverse_2_Vaccum_On_Sol_Valve, OutputData.LD_Cell_Reverse_2_Blow_On_Sol_Valve, InputData.LD_Cell_Reverse_2_Vaccum_On_Check, En_Alarm_List.AL_0661_LD_REVERSE_2_VACUUM_ON_CHECK);
|
|
pauseDisableList.Add(LoaderReverseStageSteps.S1205_Z_POSITION_CHECK);
|
pauseDisableList.Add(LoaderReverseStageSteps.S1215_R_POSITION_CHECK);
|
pauseDisableList.Add(LoaderReverseStageSteps.S2205_Z_POSITION_CHECK);
|
pauseDisableList.Add(LoaderReverseStageSteps.S2215_R_POSITION_CHECK);
|
pauseDisableList.Add(LoaderReverseStageSteps.S2225_Z_POSITION_CHECK);
|
|
MotorR1.Check_Jog_Interlock = Jog_Interlock;
|
MotorR1.Check_Move_Interlock = Move_Interlock;
|
MotorZ1.Check_Jog_Interlock = Jog_Interlock;
|
MotorZ1.Check_Move_Interlock = Move_Interlock;
|
|
MotorR2.Check_Jog_Interlock = Jog_Interlock;
|
MotorR2.Check_Move_Interlock = Move_Interlock;
|
MotorZ2.Check_Jog_Interlock = Jog_Interlock;
|
MotorZ2.Check_Move_Interlock = Move_Interlock;
|
}
|
#endregion
|
|
#region Function
|
private bool Move_Interlock()
|
{
|
if (equipment.User.Level != En_User_Level.Master && equipment.Door_Opened)
|
{
|
return true;
|
}
|
|
return false;
|
}
|
|
private bool Jog_Interlock(bool positive)
|
{
|
if (equipment.User.Level != En_User_Level.Master && equipment.Door_Opened)
|
{
|
return true;
|
}
|
|
return false;
|
}
|
|
public void Init_Seq()
|
{
|
Step = LoaderReverseStageSteps.S0000_WAIT;
|
_homeStep = ReverseStageHomeSteps.S0000_WAIT;
|
|
Tact_Move.Reset();
|
}
|
|
private void ExecuteAuto()
|
{
|
if(Step == LoaderReverseStageSteps.S0000_WAIT)
|
{
|
if(IsExist)
|
{
|
if (equipment.Cur_Main_Recipe.tray_info.Ld_Reverse && equipment.before.PreAlignStage.IsPlaceEnable)
|
{
|
Step = LoaderReverseStageSteps.S2000_PANEL_UNLOAD_START;
|
}
|
}
|
else
|
{
|
Step = LoaderReverseStageSteps.S1000_PANEL_LOAD_START;
|
}
|
}
|
}
|
|
public override void MonitoringStatus()
|
{
|
if (UnitMode == En_Equipment_Mode.Auto || UnitMode == En_Equipment_Mode.Manual)
|
{
|
if (Stage1.IsWorkEnd && Stage1.VacuumSolOn == true && Stage1.IsVacuumSensor == false)
|
{
|
Alarm_Manager.Instance.Occurred(En_Alarm_List.AL_0660_LD_REVERSE_1_VACUUM_ON_CHECK);
|
}
|
|
if (Stage2.IsWorkEnd && Stage2.VacuumSolOn == true && Stage2.IsVacuumSensor == false)
|
{
|
Alarm_Manager.Instance.Occurred(En_Alarm_List.AL_0661_LD_REVERSE_2_VACUUM_ON_CHECK);
|
}
|
}
|
|
if (equipment.User.Level != En_User_Level.Master && equipment.Door_Opened)
|
{
|
if (MotorZ1.MotionComplete == false)
|
{
|
MotorZ1.Move_Stop();
|
}
|
|
if (MotorR1.MotionComplete == false)
|
{
|
MotorR1.Move_Stop();
|
}
|
|
if (MotorZ2.MotionComplete == false)
|
{
|
MotorZ2.Move_Stop();
|
}
|
|
if (MotorR2.MotionComplete == false)
|
{
|
MotorR2.Move_Stop();
|
}
|
}
|
}
|
|
public override void ExecuteStep()
|
{
|
if (_oldStep != Step)
|
{
|
sequenceChangedTime.Restart();
|
_oldStep = Step;
|
WriteSequenceLog(Step.ToString());
|
}
|
|
Stage1.ExecuteProcess();
|
Stage2.ExecuteProcess();
|
|
Seq_Stage1Step();
|
Seq_Stage2Step();
|
|
if (UnitMode == En_Equipment_Mode.Stop)
|
{
|
Init_Seq();
|
isHomeComplete = false;
|
}
|
else if (UnitMode == En_Equipment_Mode.Pause)
|
{
|
sequenceChangedTime.Stop();
|
}
|
else if (UnitMode == En_Equipment_Mode.Home)
|
{
|
if (IsHomeComplete == false)
|
{
|
ExecuteHome();
|
}
|
else
|
{
|
if(UnitMode != equipment.equip_mode)
|
{
|
UnitMode = equipment.equip_mode;
|
}
|
}
|
}
|
else if (UnitMode == En_Equipment_Mode.Auto || UnitMode == En_Equipment_Mode.Manual)
|
{
|
sequenceChangedTime.Start();
|
|
if (equipment.equip_mode == En_Equipment_Mode.Pause)
|
{
|
if (pauseDisableList.Contains(Step) == false)
|
{
|
UnitMode = En_Equipment_Mode.Pause;
|
return;
|
}
|
}
|
|
if (UnitMode == En_Equipment_Mode.Auto)
|
ExecuteAuto();
|
|
Seq_Load();
|
Seq_Unload();
|
}
|
}
|
|
public void ExecuteHome()
|
{
|
switch (_homeStep)
|
{
|
case ReverseStageHomeSteps.S0000_WAIT:
|
{
|
_homeStep = ReverseStageHomeSteps.S1000_STATUS_CHECK;
|
break;
|
}
|
case ReverseStageHomeSteps.S1000_STATUS_CHECK:
|
{
|
if (MotorR1.ErrorStop || MotorZ1.ErrorStop || MotorR2.ErrorStop || MotorZ2.ErrorStop)
|
{
|
if (MotorR1.ErrorStop)
|
{
|
Alarm_Manager.Instance.Occurred(En_Alarm_List.AL_0201_LD_ROTATION_UNIT_R_1_ERROR_STOP);
|
}
|
if (MotorZ1.ErrorStop)
|
{
|
Alarm_Manager.Instance.Occurred(En_Alarm_List.AL_0191_LD_ROTATION_UNIT_Z_1_ERROR_STOP);
|
}
|
if (MotorR2.ErrorStop)
|
{
|
Alarm_Manager.Instance.Occurred(En_Alarm_List.AL_0221_LD_ROTATION_UNIT_R_2_ERROR_STOP);
|
}
|
if (MotorZ2.ErrorStop)
|
{
|
Alarm_Manager.Instance.Occurred(En_Alarm_List.AL_0211_LD_ROTATION_UNIT_Z_2_ERROR_STOP);
|
}
|
}
|
else if (!MotorR1.PowerOn || !MotorZ1.PowerOn || !MotorR2.PowerOn || !MotorZ2.PowerOn)
|
{
|
if (MotorR1.PowerOn)
|
{
|
Alarm_Manager.Instance.Occurred(En_Alarm_List.AL_0200_LD_ROTATION_UNIT_R_1_POWER_OFF);
|
}
|
if (MotorZ1.PowerOn)
|
{
|
Alarm_Manager.Instance.Occurred(En_Alarm_List.AL_0190_LD_ROTATION_UNIT_Z_1_POWER_OFF);
|
}
|
if (MotorR2.PowerOn)
|
{
|
Alarm_Manager.Instance.Occurred(En_Alarm_List.AL_0220_LD_ROTATION_UNIT_R_2_POWER_OFF);
|
}
|
if (MotorZ2.PowerOn)
|
{
|
Alarm_Manager.Instance.Occurred(En_Alarm_List.AL_0210_LD_ROTATION_UNIT_Z_2_POWER_OFF);
|
}
|
}
|
else
|
{
|
if(equipment.loader.Handler1.IsHomeComplete && equipment.before.Handler2.IsHomeComplete)
|
_homeStep = ReverseStageHomeSteps.S2000_Z_HOME_START;
|
}
|
break;
|
}
|
case ReverseStageHomeSteps.S2000_Z_HOME_START:
|
{
|
if(MotorZ1.Home())
|
{
|
if(MotorZ2.Home())
|
{
|
homeCheckedTime.Restart();
|
_homeStep = ReverseStageHomeSteps.S2100_Z_HOME_CHECK;
|
}
|
}
|
break;
|
}
|
case ReverseStageHomeSteps.S2100_Z_HOME_CHECK:
|
{
|
if (homeCheckedTime.Seconds < 1) return;
|
|
if (!MotorZ1.IsHomed || !MotorZ2.IsHomed)
|
{
|
if (MotorZ1.Homing == false && MotorZ1.ErrorStop)
|
{
|
Alarm_Manager.Instance.Occurred(En_Alarm_List.AL_0191_LD_ROTATION_UNIT_Z_1_ERROR_STOP);
|
}
|
|
if (MotorZ2.Homing == false && MotorZ2.ErrorStop)
|
{
|
Alarm_Manager.Instance.Occurred(En_Alarm_List.AL_0211_LD_ROTATION_UNIT_Z_2_ERROR_STOP);
|
}
|
}
|
else
|
{
|
_homeStep = ReverseStageHomeSteps.S2200_R_HOME_START;
|
}
|
break;
|
}
|
case ReverseStageHomeSteps.S2200_R_HOME_START:
|
{
|
if (MotorR1.Home())
|
{
|
if (MotorR2.Home())
|
{
|
homeCheckedTime.Restart();
|
_homeStep = ReverseStageHomeSteps.S2300_R_HOME_CHECK;
|
}
|
}
|
break;
|
}
|
case ReverseStageHomeSteps.S2300_R_HOME_CHECK:
|
{
|
if (homeCheckedTime.Seconds < 1) return;
|
|
if (!MotorR1.IsHomed || !MotorR2.IsHomed)
|
{
|
if (MotorR1.Homing == false && MotorR1.ErrorStop)
|
{
|
Alarm_Manager.Instance.Occurred(En_Alarm_List.AL_0201_LD_ROTATION_UNIT_R_1_ERROR_STOP);
|
}
|
|
if (MotorR2.Homing == false && MotorR2.ErrorStop)
|
{
|
Alarm_Manager.Instance.Occurred(En_Alarm_List.AL_0221_LD_ROTATION_UNIT_R_2_ERROR_STOP);
|
}
|
}
|
else
|
{
|
_homeStep = ReverseStageHomeSteps.S3000_R_MOVE_180_DEG;
|
}
|
break;
|
}
|
case ReverseStageHomeSteps.S3000_R_MOVE_180_DEG:
|
{
|
if(Move_R_1_Deg_180_Position())
|
{
|
if (Move_R_2_Deg_180_Position())
|
{
|
homeCheckedTime.Restart();
|
_homeStep = ReverseStageHomeSteps.S3100_R_POSITION_CHECK;
|
}
|
}
|
|
break;
|
}
|
case ReverseStageHomeSteps.S3100_R_POSITION_CHECK:
|
{
|
if (homeCheckedTime.Seconds < 1) return;
|
|
if (MotorR1.ErrorStop || MotorR2.ErrorStop)
|
{
|
if (MotorR1.ErrorStop)
|
{
|
Alarm_Manager.Instance.Occurred(En_Alarm_List.AL_0201_LD_ROTATION_UNIT_R_1_ERROR_STOP);
|
}
|
|
if (MotorR2.ErrorStop)
|
{
|
Alarm_Manager.Instance.Occurred(En_Alarm_List.AL_0221_LD_ROTATION_UNIT_R_2_ERROR_STOP);
|
}
|
}
|
else if (MotorR1.MotionComplete && MotorR2.MotionComplete)
|
{
|
if (IsPositionR1Degree180 && IsPositionR2Degree180)
|
{
|
_homeStep = ReverseStageHomeSteps.S3200_Z_MOVE_DOWN_POSITION;
|
}
|
else
|
{
|
if(!IsPositionR1Degree180)
|
{
|
Interlock_Manager.Add_Interlock_Msg("LD Reverse Home can't run.", "Reverse R 1 is not 180 deg.");
|
}
|
|
if (!IsPositionR2Degree180)
|
{
|
Interlock_Manager.Add_Interlock_Msg("LD Reverse Home can't run.", "Reverse R 2 is not 180 deg.");
|
}
|
}
|
}
|
break;
|
}
|
case ReverseStageHomeSteps.S3200_Z_MOVE_DOWN_POSITION:
|
{
|
if (Move_Z_1_Down_Position())
|
{
|
if (Move_Z_2_Down_Position())
|
{
|
homeCheckedTime.Restart();
|
_homeStep = ReverseStageHomeSteps.S3300_Z_POSITION_CHECK;
|
}
|
}
|
break;
|
}
|
case ReverseStageHomeSteps.S3300_Z_POSITION_CHECK:
|
{
|
if (homeCheckedTime.Seconds < 1) return;
|
|
if (MotorZ1.ErrorStop || MotorZ2.ErrorStop)
|
{
|
if (MotorZ1.ErrorStop)
|
{
|
Alarm_Manager.Instance.Occurred(En_Alarm_List.AL_0191_LD_ROTATION_UNIT_Z_1_ERROR_STOP);
|
}
|
|
if (MotorZ2.ErrorStop)
|
{
|
Alarm_Manager.Instance.Occurred(En_Alarm_List.AL_0211_LD_ROTATION_UNIT_Z_2_ERROR_STOP);
|
}
|
}
|
else if (MotorZ1.MotionComplete && MotorZ2.MotionComplete)
|
{
|
if (IsPositionZ1Down && IsPositionZ2Down)
|
{
|
_homeStep = ReverseStageHomeSteps.S9999_END;
|
}
|
else
|
{
|
if (!IsPositionZ1Down)
|
{
|
Interlock_Manager.Add_Interlock_Msg("LD Reverse Home can't run.", "Reverse Z 1 is not down position.");
|
}
|
|
if (!IsPositionZ2Down)
|
{
|
Interlock_Manager.Add_Interlock_Msg("LD Reverse Home can't run.", "Reverse Z 2 is not down position.");
|
}
|
}
|
}
|
break;
|
}
|
case ReverseStageHomeSteps.S9999_END:
|
{
|
isHomeComplete = true;
|
_homeStep = ReverseStageHomeSteps.S0000_WAIT;
|
break;
|
}
|
}
|
}
|
|
public void Seq_Load()
|
{
|
switch (Step)
|
{
|
case LoaderReverseStageSteps.S1000_PANEL_LOAD_START:
|
{
|
Tact_Move.Restart();
|
Step = LoaderReverseStageSteps.S1100_HANDLER1_POSITION_CHECK;
|
break;
|
}
|
case LoaderReverseStageSteps.S1100_HANDLER1_POSITION_CHECK:
|
{
|
double position = equipment.loader.Handler1.Get_Position_Y_Stay();
|
|
if (position >= equipment.loader.Handler1.MotorY.Position || equipment.loader.Handler1.MotorY.Is_Inposition(position, equipment.Setting.Inposition_Offset))
|
{
|
Step = LoaderReverseStageSteps.S1110_HANDLER2_POSITION_CHECK;
|
}
|
break;
|
}
|
case LoaderReverseStageSteps.S1110_HANDLER2_POSITION_CHECK:
|
{
|
double position = equipment.before.Handler2.Get_Position_Y_Stay();
|
|
if (position >= equipment.before.Handler2.MotorY.Position || equipment.before.Handler2.MotorY.Is_Inposition(position, equipment.Setting.Inposition_Offset))
|
{
|
if (IsStayPosition)
|
{
|
Step = LoaderReverseStageSteps.S1230_PANEL_EXIST_CHECK;
|
}
|
else
|
{
|
Step = LoaderReverseStageSteps.S1200_MOVE_Z_UP_POSITION;
|
}
|
}
|
break;
|
}
|
case LoaderReverseStageSteps.S1200_MOVE_Z_UP_POSITION:
|
{
|
if (Move_Z_1_Up_Position() && Move_Z_2_Up_Position())
|
{
|
Step = LoaderReverseStageSteps.S1205_Z_POSITION_CHECK;
|
}
|
break;
|
}
|
case LoaderReverseStageSteps.S1205_Z_POSITION_CHECK:
|
{
|
if (MotorZ1.MotionComplete && MotorZ2.MotionComplete)
|
{
|
if (IsPositionZ1Up && IsPositionZ2Up)
|
{
|
Step = LoaderReverseStageSteps.S1210_MOVE_R_DEG_180;
|
}
|
else
|
{
|
Step = LoaderReverseStageSteps.S1200_MOVE_Z_UP_POSITION;
|
}
|
}
|
break;
|
}
|
case LoaderReverseStageSteps.S1210_MOVE_R_DEG_180:
|
{
|
if (Move_R_1_Deg_180_Position() && Move_R_2_Deg_180_Position())
|
{
|
Step = LoaderReverseStageSteps.S1215_R_POSITION_CHECK;
|
}
|
break;
|
}
|
case LoaderReverseStageSteps.S1215_R_POSITION_CHECK:
|
{
|
if (MotorR1.MotionComplete && MotorR2.MotionComplete)
|
{
|
if (IsPositionR1Degree180 && IsPositionR2Degree180)
|
{
|
Step = LoaderReverseStageSteps.S1220_MOVE_Z_DOWN;
|
}
|
else
|
{
|
Step = LoaderReverseStageSteps.S1210_MOVE_R_DEG_180;
|
}
|
}
|
|
break;
|
}
|
case LoaderReverseStageSteps.S1220_MOVE_Z_DOWN:
|
{
|
if (Move_Z_1_Down_Position() && Move_Z_2_Down_Position())
|
{
|
Step = LoaderReverseStageSteps.S1225_Z_POSITION_CHECK;
|
}
|
break;
|
}
|
case LoaderReverseStageSteps.S1225_Z_POSITION_CHECK:
|
{
|
if (IsPositionZ1Down && IsPositionZ2Down)
|
{
|
Tact_Move.Stop();
|
Step = LoaderReverseStageSteps.S1230_PANEL_EXIST_CHECK;
|
}
|
break;
|
}
|
case LoaderReverseStageSteps.S1230_PANEL_EXIST_CHECK:
|
{
|
if(Stage1.IsWorkEnd && Stage2.IsWorkEnd)
|
{
|
if(IsExist)
|
{
|
Step = LoaderReverseStageSteps.S1999_PANEL_LOAD_END;
|
}
|
}
|
break;
|
}
|
case LoaderReverseStageSteps.S1999_PANEL_LOAD_END:
|
{
|
Step = LoaderReverseStageSteps.S0000_WAIT;
|
break;
|
}
|
}
|
}
|
|
public void Seq_Unload()
|
{
|
switch(Step)
|
{
|
case LoaderReverseStageSteps.S2000_PANEL_UNLOAD_START:
|
{
|
Tact_Move.Restart();
|
Step = LoaderReverseStageSteps.S2100_HANDLER1_POSITION_CHECK;
|
|
break;
|
}
|
case LoaderReverseStageSteps.S2100_HANDLER1_POSITION_CHECK:
|
{
|
double position = equipment.loader.Handler1.Get_Position_Y_Stay();
|
|
if (position >= equipment.loader.Handler1.MotorY.Position || equipment.loader.Handler1.MotorY.Is_Inposition(position, equipment.Setting.Inposition_Offset))
|
{
|
Step = LoaderReverseStageSteps.S2110_HANDLER2_POSITION_CHECK;
|
}
|
break;
|
}
|
case LoaderReverseStageSteps.S2110_HANDLER2_POSITION_CHECK:
|
{
|
double position = equipment.before.Handler2.Get_Position_Y_Stay();
|
|
if (position >= equipment.before.Handler2.MotorY.Position || equipment.before.Handler2.MotorY.Is_Inposition(position, equipment.Setting.Inposition_Offset))
|
{
|
Step = LoaderReverseStageSteps.S2200_MOVE_Z_UP;
|
}
|
break;
|
}
|
case LoaderReverseStageSteps.S2200_MOVE_Z_UP:
|
{
|
if(Move_Z_1_Up_Position() && Move_Z_2_Up_Position())
|
{
|
Step = LoaderReverseStageSteps.S2205_Z_POSITION_CHECK;
|
}
|
break;
|
}
|
case LoaderReverseStageSteps.S2205_Z_POSITION_CHECK:
|
{
|
if (MotorZ1.MotionComplete && MotorZ2.MotionComplete)
|
{
|
if (IsPositionZ1Up && IsPositionZ2Up)
|
{
|
Step = LoaderReverseStageSteps.S2210_MOVE_R_DEG_0;
|
}
|
else
|
{
|
Step = LoaderReverseStageSteps.S2200_MOVE_Z_UP;
|
}
|
}
|
|
break;
|
}
|
case LoaderReverseStageSteps.S2210_MOVE_R_DEG_0:
|
{
|
if (Move_R_1_Deg_0_Position() && Move_R_2_Deg_0_Position())
|
{
|
Step = LoaderReverseStageSteps.S2215_R_POSITION_CHECK;
|
}
|
break;
|
}
|
case LoaderReverseStageSteps.S2215_R_POSITION_CHECK:
|
{
|
if (MotorR1.MotionComplete && MotorR2.MotionComplete)
|
{
|
if (IsPositionR1Degree0 && IsPositionR2Degree0)
|
{
|
Step = LoaderReverseStageSteps.S2220_MOVE_Z_DOWN;
|
}
|
else
|
{
|
Step = LoaderReverseStageSteps.S2210_MOVE_R_DEG_0;
|
}
|
}
|
break;
|
}
|
case LoaderReverseStageSteps.S2220_MOVE_Z_DOWN:
|
{
|
if(Move_Z_1_Down_Position() && Move_Z_2_Down_Position())
|
{
|
Step = LoaderReverseStageSteps.S2225_Z_POSITION_CHECK;
|
}
|
break;
|
}
|
case LoaderReverseStageSteps.S2225_Z_POSITION_CHECK:
|
{
|
if (MotorZ1.MotionComplete && MotorZ2.MotionComplete)
|
{
|
if (IsPositionZ1Down && IsPositionZ2Down)
|
{
|
Step = LoaderReverseStageSteps.S2300_PLACE_START;
|
}
|
else
|
{
|
Step = LoaderReverseStageSteps.S2220_MOVE_Z_DOWN;
|
}
|
}
|
break;
|
}
|
case LoaderReverseStageSteps.S2300_PLACE_START:
|
{
|
if(_stage1Step == StageSteps.S0000_WAIT && _stage2Step == StageSteps.S0000_WAIT)
|
{
|
if(Stage1.IsExist)
|
{
|
_stage1Step = StageSteps.S1000_PLACE_PRE_ALIGN_STAGE_START;
|
}
|
|
if (Stage2.IsExist)
|
{
|
_stage2Step = StageSteps.S1000_PLACE_PRE_ALIGN_STAGE_START;
|
}
|
|
Step = LoaderReverseStageSteps.S2310_PLACE_WAIT;
|
}
|
break;
|
}
|
case LoaderReverseStageSteps.S2310_PLACE_WAIT:
|
{
|
if (_stage1Step == StageSteps.S0000_WAIT && _stage2Step == StageSteps.S0000_WAIT)
|
{
|
Step = LoaderReverseStageSteps.S2999_PANEL_UNLOAD_END;
|
}
|
break;
|
}
|
case LoaderReverseStageSteps.S2999_PANEL_UNLOAD_END:
|
{
|
Tact_Move.Stop();
|
Step = LoaderReverseStageSteps.S1000_PANEL_LOAD_START;
|
break;
|
}
|
}
|
}
|
|
public void Seq_Stage1Step()
|
{
|
switch(_stage1Step)
|
{
|
case StageSteps.S1000_PLACE_PRE_ALIGN_STAGE_START:
|
{
|
_stage1Step = StageSteps.S1100_PRE_ALIGN_STAGE_VACUUM_ON;
|
break;
|
}
|
case StageSteps.S1100_PRE_ALIGN_STAGE_VACUUM_ON:
|
{
|
if (equipment.before.PreAlignStage.Stage1.IsWorkEnd)
|
{
|
if (equipment.before.PreAlignStage.Stage1.VacuumSolOn)
|
{
|
_stage1Step = StageSteps.S1110_VACUUM_OFF;
|
}
|
else
|
{
|
equipment.before.PreAlignStage.Stage1.VacuumOn();
|
}
|
}
|
break;
|
}
|
case StageSteps.S1110_VACUUM_OFF:
|
{
|
if (Stage1.IsWorkEnd)
|
{
|
if (Stage1.VacuumSolOn == false)
|
{
|
_stage1Step = StageSteps.S1120_DATA_SET;
|
}
|
else
|
{
|
Stage1.VacuumOff();
|
}
|
}
|
break;
|
}
|
case StageSteps.S1120_DATA_SET:
|
{
|
var info = Panel1;
|
info.Ld_Reverse = true;
|
equipment.before.PreAlignStage.Panel1 = info;
|
Panel1 = new Panel_Info();
|
|
_stage1Step = StageSteps.S9999_STEP_END;
|
break;
|
}
|
case StageSteps.S9000_SCRAP_START:
|
{
|
_stage1Step = StageSteps.S9100_VACUUM_OFF;
|
break;
|
}
|
case StageSteps.S9100_VACUUM_OFF:
|
{
|
if (Stage1.IsWorkEnd)
|
{
|
if (Stage1.VacuumSolOn == false)
|
{
|
_stage1Step = StageSteps.S9110_DATA_SET;
|
}
|
else
|
{
|
Stage1.VacuumOff();
|
}
|
}
|
break;
|
}
|
case StageSteps.S9110_DATA_SET:
|
{
|
Panel1 = new Panel_Info();
|
_stage1Step = StageSteps.S9999_STEP_END;
|
break;
|
}
|
case StageSteps.S9999_STEP_END:
|
{
|
_stage1Step = StageSteps.S0000_WAIT;
|
break;
|
}
|
}
|
}
|
|
public void Seq_Stage2Step()
|
{
|
switch (_stage2Step)
|
{
|
case StageSteps.S1000_PLACE_PRE_ALIGN_STAGE_START:
|
{
|
_stage2Step = StageSteps.S1100_PRE_ALIGN_STAGE_VACUUM_ON;
|
break;
|
}
|
case StageSteps.S1100_PRE_ALIGN_STAGE_VACUUM_ON:
|
{
|
if (equipment.before.PreAlignStage.Stage2.IsWorkEnd)
|
{
|
if (equipment.before.PreAlignStage.Stage2.VacuumSolOn)
|
{
|
_stage2Step = StageSteps.S1110_VACUUM_OFF;
|
}
|
else
|
{
|
equipment.before.PreAlignStage.Stage2.VacuumOn();
|
}
|
}
|
break;
|
}
|
case StageSteps.S1110_VACUUM_OFF:
|
{
|
if (Stage2.IsWorkEnd)
|
{
|
if (Stage2.VacuumSolOn == false)
|
{
|
_stage2Step = StageSteps.S1120_DATA_SET;
|
}
|
else
|
{
|
Stage2.VacuumOff();
|
}
|
}
|
break;
|
}
|
case StageSteps.S1120_DATA_SET:
|
{
|
var info = Panel2;
|
info.Ld_Reverse = true;
|
equipment.before.PreAlignStage.Panel2 = info;
|
Panel2 = new Panel_Info();
|
|
_stage2Step = StageSteps.S9999_STEP_END;
|
break;
|
}
|
case StageSteps.S9000_SCRAP_START:
|
{
|
_stage2Step = StageSteps.S9100_VACUUM_OFF;
|
break;
|
}
|
case StageSteps.S9100_VACUUM_OFF:
|
{
|
if (Stage2.IsWorkEnd)
|
{
|
if (Stage2.VacuumSolOn == false)
|
{
|
_stage2Step = StageSteps.S9110_DATA_SET;
|
}
|
else
|
{
|
Stage2.VacuumOff();
|
}
|
}
|
break;
|
}
|
case StageSteps.S9110_DATA_SET:
|
{
|
Panel2 = new Panel_Info();
|
_stage2Step = StageSteps.S9999_STEP_END;
|
break;
|
}
|
case StageSteps.S9999_STEP_END:
|
{
|
_stage2Step = StageSteps.S0000_WAIT;
|
break;
|
}
|
}
|
}
|
|
public bool Move_Z_1_Down_Position()
|
{
|
object value;
|
double position;
|
double velocity;
|
equipment.sm.Get_Value(Position_Parameter_Address.LD_Reverse_Unit_1_Z_Down_Position, out value);
|
position = double.Parse($"{value}");
|
equipment.sm.Get_Value(Position_Parameter_Address.LD_Reverse_Unit_1_Z_Down_Velocity, out value);
|
velocity = double.Parse($"{value}");
|
|
return MotorZ1.Move_Absolute_Pos(position, velocity);
|
}
|
|
public bool Move_Z_1_Up_Position()
|
{
|
object value;
|
double position;
|
double velocity;
|
equipment.sm.Get_Value(Position_Parameter_Address.LD_Reverse_Unit_1_Z_Up_Position, out value);
|
position = double.Parse($"{value}");
|
equipment.sm.Get_Value(Position_Parameter_Address.LD_Reverse_Unit_1_Z_Up_Velocity, out value);
|
velocity = double.Parse($"{value}");
|
|
return MotorZ1.Move_Absolute_Pos(position, velocity);
|
}
|
|
public bool Move_R_1_Deg_0_Position()
|
{
|
object value;
|
double position;
|
double velocity;
|
equipment.sm.Get_Value(Position_Parameter_Address.LD_Reverse_Unit_1_T_0_Position, out value);
|
position = double.Parse($"{value}");
|
equipment.sm.Get_Value(Position_Parameter_Address.LD_Reverse_Unit_1_T_0_Velocity, out value);
|
velocity = double.Parse($"{value}");
|
|
return MotorR1.Move_Absolute_Pos(position, velocity);
|
}
|
|
public bool Move_R_1_Deg_180_Position()
|
{
|
object value;
|
double position;
|
double velocity;
|
equipment.sm.Get_Value(Position_Parameter_Address.LD_Reverse_Unit_1_T_180_Position, out value);
|
position = double.Parse($"{value}");
|
equipment.sm.Get_Value(Position_Parameter_Address.LD_Reverse_Unit_1_T_180_Velocity, out value);
|
velocity = double.Parse($"{value}");
|
|
return MotorR1.Move_Absolute_Pos(position, velocity);
|
}
|
|
public bool Move_Z_2_Down_Position()
|
{
|
object value;
|
double position;
|
double velocity;
|
equipment.sm.Get_Value(Position_Parameter_Address.LD_Reverse_Unit_2_Z_Down_Position, out value);
|
position = double.Parse($"{value}");
|
equipment.sm.Get_Value(Position_Parameter_Address.LD_Reverse_Unit_2_Z_Down_Velocity, out value);
|
velocity = double.Parse($"{value}");
|
|
return MotorZ2.Move_Absolute_Pos(position, velocity);
|
}
|
|
public bool Move_Z_2_Up_Position()
|
{
|
object value;
|
double position;
|
double velocity;
|
equipment.sm.Get_Value(Position_Parameter_Address.LD_Reverse_Unit_2_Z_Up_Position, out value);
|
position = double.Parse($"{value}");
|
equipment.sm.Get_Value(Position_Parameter_Address.LD_Reverse_Unit_2_Z_Up_Velocity, out value);
|
velocity = double.Parse($"{value}");
|
|
return MotorZ2.Move_Absolute_Pos(position, velocity);
|
}
|
|
public bool Move_R_2_Deg_0_Position()
|
{
|
object value;
|
double position;
|
double velocity;
|
equipment.sm.Get_Value(Position_Parameter_Address.LD_Reverse_Unit_2_T_0_Position, out value);
|
position = double.Parse($"{value}");
|
equipment.sm.Get_Value(Position_Parameter_Address.LD_Reverse_Unit_2_T_0_Velocity, out value);
|
velocity = double.Parse($"{value}");
|
|
return MotorR2.Move_Absolute_Pos(position, velocity);
|
}
|
|
public bool Move_R_2_Deg_180_Position()
|
{
|
object value;
|
double position;
|
double velocity;
|
equipment.sm.Get_Value(Position_Parameter_Address.LD_Reverse_Unit_2_T_180_Position, out value);
|
position = double.Parse($"{value}");
|
equipment.sm.Get_Value(Position_Parameter_Address.LD_Reverse_Unit_2_T_180_Velocity, out value);
|
velocity = double.Parse($"{value}");
|
|
return MotorR2.Move_Absolute_Pos(position, velocity);
|
}
|
|
public bool Picker_1_Scrap()
|
{
|
if (UnitMode == En_Equipment_Mode.Auto || equipment.Auto_Mode)
|
{
|
Interlock_Manager.Add_Interlock_Msg("LD_Reverse_1 Scrap Can't Start", "Equipment mode is Auto.");
|
return false;
|
}
|
|
_stage1Step = StageSteps.S9000_SCRAP_START;
|
return true;
|
}
|
|
public bool Picker_2_Scrap()
|
{
|
if (UnitMode == En_Equipment_Mode.Auto || equipment.Auto_Mode)
|
{
|
Interlock_Manager.Add_Interlock_Msg("LD_Reverse_2 Scrap Can't Start", "Equipment mode is Auto.");
|
return false;
|
}
|
|
_stage2Step = StageSteps.S9000_SCRAP_START;
|
return true;
|
}
|
#endregion
|
}
|
}
|
