From 217577e6cb9262757f709de89d97582a1fe1e5e5 Mon Sep 17 00:00:00 2001
From: 천호석 <hosuk1418@naver.com>
Date: 금, 16 12월 2022 08:37:38 +0900
Subject: [PATCH] 1. Laser on Interlock에 Power meter 위치 추가 2. Auto power 측정중 pause시 자동 종료 추가.

---
 SHARP_CLAS_UI/500.Equipment/700.Unit/200.Process/Ablation.cs |  243 +++++++++++++++++++++++++++++++++++++++++++----
 1 files changed, 219 insertions(+), 24 deletions(-)

diff --git a/SHARP_CLAS_UI/500.Equipment/700.Unit/200.Process/Ablation.cs b/SHARP_CLAS_UI/500.Equipment/700.Unit/200.Process/Ablation.cs
index 4258669..a9d0c1b 100644
--- a/SHARP_CLAS_UI/500.Equipment/700.Unit/200.Process/Ablation.cs
+++ b/SHARP_CLAS_UI/500.Equipment/700.Unit/200.Process/Ablation.cs
@@ -109,11 +109,33 @@
             pauseDisableList.Add(AblationSteps.S4135_POSITION_CHECK);
             pauseDisableList.Add(AblationSteps.S4215_ABLATION_PROCESS_WAIT);
             pauseDisableList.Add(AblationSteps.S4225_POSITION_CHECK);
-
+            
             pauseDisableList.Add(AblationSteps.S5220_SCANNER_MOVE_WAIT);
 
-            MotorX.Check_Jog_Interlock = Jog_Interlock;
-            MotorX.Check_Move_Interlock = Move_Interlock;
+            pauseDisableList.Add(AblationSteps.S5320_LASER_ON);
+            pauseDisableList.Add(AblationSteps.S5330_LASER_ON_CHECK);
+            pauseDisableList.Add(AblationSteps.S5340_POWER_MEASUREMENT_START);
+            pauseDisableList.Add(AblationSteps.S5350_POWER_MEASUREMENT);
+            pauseDisableList.Add(AblationSteps.S5360_POWER_MEASUREMENT_END);
+            pauseDisableList.Add(AblationSteps.S5370_LASER_OFF);
+            pauseDisableList.Add(AblationSteps.S5380_LASER_OFF_CHECK);
+
+            pauseDisableList.Add(AblationSteps.S5420_LASER_ON);
+            pauseDisableList.Add(AblationSteps.S5430_LASER_ON_CHECK);
+            pauseDisableList.Add(AblationSteps.S5440_POWER_MEASUREMENT_START);
+            pauseDisableList.Add(AblationSteps.S5450_POWER_MEASUREMENT);
+            pauseDisableList.Add(AblationSteps.S5460_POWER_MEASUREMENT_END);
+            pauseDisableList.Add(AblationSteps.S5470_LASER_OFF);
+            pauseDisableList.Add(AblationSteps.S5480_LASER_OFF_CHECK);
+
+            pauseDisableList.Add(AblationSteps.S6000_MOVE_STAY_POSITION);
+            pauseDisableList.Add(AblationSteps.S6010_LASER_OFF);
+            pauseDisableList.Add(AblationSteps.S6020_LASER_OFF_CHECK);
+            pauseDisableList.Add(AblationSteps.S6100_MOVE_WAIT);
+            pauseDisableList.Add(AblationSteps.S5999_AUTO_POWER_END);
+
+            MotorX.Check_Jog_Interlock = Jog_Interlock_MotorX;
+            MotorX.Check_Move_Interlock = Move_Interlock_MotorX;
             MotorZ.Check_Jog_Interlock = Jog_Interlock;
             MotorZ.Check_Move_Interlock = Move_Interlock;
 
@@ -124,6 +146,40 @@
         #endregion
 
         #region Function
+        private bool Move_Interlock_MotorX()
+        {
+            if (equipment.User.Level != En_User_Level.Master && equipment.Door_Opened)
+            {
+                return true;
+            }
+
+            double position = Get_Scanner_Z_A1_Stay_Position();
+
+            if (MotorZ.Is_Inposition(position, equipment.Setting.Inposition_Offset) == false)
+            {
+                return true;
+            }
+
+            return false;
+        }
+
+        private bool Jog_Interlock_MotorX(bool positive)
+        {
+            if (equipment.User.Level != En_User_Level.Master && equipment.Door_Opened)
+            {
+                return true;
+            }
+
+            double position = Get_Scanner_Z_A1_Stay_Position();
+
+            if (MotorZ.Is_Inposition(position, equipment.Setting.Inposition_Offset) == false)
+            {
+                return true;
+            }
+
+            return false;
+        }
+
         private bool Move_Interlock()
         {
             if (equipment.User.Level != En_User_Level.Master && equipment.Door_Opened)
@@ -196,6 +252,7 @@
                 if (on)
                 {
                     equipment.scanner.Set_Stop();
+                    equipment.scanner.Set_Laser_Off();
                 }
             }
         }
@@ -242,6 +299,12 @@
                 {
                     if (pauseDisableList.Contains(Step) == false)
                     {
+                        if(Is_Power_Measure)
+                        {
+                            Step = AblationSteps.S6000_MOVE_STAY_POSITION;
+                            return;
+                        }
+
                         UnitMode = En_Equipment_Mode.Pause;
                         return;
                     }
@@ -1310,6 +1373,19 @@
 
         private void Seq_Power_Measure()
         {
+            //Laser 異쒖궗 �쐞移섏뿉�꽌 Power Meter�쐞移섍� �븘�땺 �븣 Laser off �썑 泥� Step�쑝濡� �씠�룞.
+            if((AblationSteps.S5320_LASER_ON <= Step && Step <= AblationSteps.S5360_POWER_MEASUREMENT_END) ||
+                (AblationSteps.S5420_LASER_ON <= Step && Step <= AblationSteps.S5460_POWER_MEASUREMENT_END))
+            {
+                if (equipment.process.ablation.Get_Is_Position_X_Power_Meter() == false || equipment.process.ablation.Get_Is_Position_Z_Power_Meter() == false)
+                {
+                    if (equipment.scanner.Set_Laser_Off())
+                    {
+                        Step = AblationSteps.S0000_WAIT;
+                    }
+                }
+            }
+
             switch (Step)
             {
                 case AblationSteps.S5000_AUTO_POWER_START:
@@ -1331,7 +1407,7 @@
                         else
                         {
                             auto_power_view.Add_Info($"Power Meter Status Fail");
-                            Step = AblationSteps.S5999_AUTO_POWER_END;
+                            Step = AblationSteps.S6000_MOVE_STAY_POSITION;
                         }
                         break;
                     }
@@ -1352,32 +1428,81 @@
                 case AblationSteps.S5130_ZERO_SET:
                     {
                         equipment.power_meter.Set_Zero();
-                        Step = AblationSteps.S5210_SCANNER_POSITION_MOVE;
+                        Step = AblationSteps.S5150_MOVE_Z_STAY_POSITION;
                         break;
                     }
-                case AblationSteps.S5210_SCANNER_POSITION_MOVE:
+                case AblationSteps.S5150_MOVE_Z_STAY_POSITION:
+                    {
+                        double position = Get_Scanner_Z_A1_Stay_Position();
+
+                        if (MotorZ.Move_Absolute_Pos(position, 500))
+                        {
+                            Step = AblationSteps.S5160_POSITION_CHECK;
+                        }
+                        break;
+                    }
+                case AblationSteps.S5160_POSITION_CHECK:
+                    {
+                        double position = Get_Scanner_Z_A1_Stay_Position();
+
+                        if (MotorZ.MotionComplete)
+                        {
+                            if (MotorZ.Is_Inposition(position, equipment.Setting.Inposition_Offset))
+                            {
+                                auto_power_view.Add_Info($"Scanner Position Z WAIT MOVE");
+                                Step = AblationSteps.S5210_SCANNER_POSITION_X_MOVE;
+                            }
+                            else
+                            {
+                                Step = AblationSteps.S5150_MOVE_Z_STAY_POSITION;
+                            }
+                        }
+                        break;
+                    }
+                case AblationSteps.S5210_SCANNER_POSITION_X_MOVE:
                     {
                         if (equipment.process.ablation.Move_X_Power_Meter_Position())
                         {
-                            if (equipment.process.ablation.Move_Z_Power_Meter_Position())
-                            {
-                                Step = AblationSteps.S5220_SCANNER_MOVE_WAIT;
-                            }
+                            Step = AblationSteps.S5220_SCANNER_MOVE_WAIT;
                         }
                         break;
                     }
                 case AblationSteps.S5220_SCANNER_MOVE_WAIT:
                     {
-                        if (equipment.process.ablation.MotorX.MotionComplete && equipment.process.ablation.MotorZ.MotionComplete)
+                        if (equipment.process.ablation.MotorX.MotionComplete)
                         {
-                            if (equipment.process.ablation.Get_Is_Position_X_Power_Meter() && equipment.process.ablation.Get_Is_Position_Z_Power_Meter())
+                            if (equipment.process.ablation.Get_Is_Position_X_Power_Meter())
                             {
-                                auto_power_view.Add_Info($"Scanner Position Move");
+                                auto_power_view.Add_Info($"Scanner Position X Power meter Move");
+                                Step = AblationSteps.S5230_SCANNER_POSITION_Z_MOVE;
+                            }
+                            else
+                            {
+                                Step = AblationSteps.S5210_SCANNER_POSITION_X_MOVE;
+                            }
+                        }
+                        break;
+                    }
+                case AblationSteps.S5230_SCANNER_POSITION_Z_MOVE:
+                    {
+                        if (equipment.process.ablation.Move_Z_Power_Meter_Position())
+                        {
+                            Step = AblationSteps.S5240_SCANNER_MOVE_WAIT;
+                        }
+                        break;
+                    }
+                case AblationSteps.S5240_SCANNER_MOVE_WAIT:
+                    {
+                        if (equipment.process.ablation.MotorZ.MotionComplete)
+                        {
+                            if (equipment.process.ablation.Get_Is_Position_Z_Power_Meter())
+                            {
+                                auto_power_view.Add_Info($"Scanner Position Z Power meter Move");
                                 Step = AblationSteps.S5300_SCANNER_INIT;
                             }
                             else
                             {
-                                Step = AblationSteps.S5210_SCANNER_POSITION_MOVE;
+                                Step = AblationSteps.S5230_SCANNER_POSITION_Z_MOVE;
                             }
                         }
                         break;
@@ -1413,10 +1538,20 @@
                     }
                 case AblationSteps.S5320_LASER_ON:
                     {
-                        if (equipment.scanner.Set_Laser_On())
+                        if (equipment.process.ablation.MotorX.MotionComplete && equipment.process.ablation.MotorZ.MotionComplete)
                         {
-                            auto_power_view.Add_Info($"Laser On.");
-                            Step = AblationSteps.S5330_LASER_ON_CHECK;
+                            if (equipment.process.ablation.Get_Is_Position_X_Power_Meter() && equipment.process.ablation.Get_Is_Position_Z_Power_Meter())
+                            {
+                                if (equipment.scanner.Set_Laser_On())
+                                {
+                                    auto_power_view.Add_Info($"Laser On.");
+                                    Step = AblationSteps.S5330_LASER_ON_CHECK;
+                                }
+                            }
+                            else
+                            {
+                                Step = AblationSteps.S0000_WAIT;
+                            }
                         }
                         break;
                     }
@@ -1497,7 +1632,7 @@
                         {
                             //alarm.
                             Alarm_Manager.Instance.Occurred(En_Alarm_List.AL_0942_POWER_COUNT_IS_EMPTY);
-                            Step = AblationSteps.S5999_AUTO_POWER_END;
+                            Step = AblationSteps.S6000_MOVE_STAY_POSITION;
                         }
 
                         double averager = lst_power.Average();
@@ -1525,7 +1660,7 @@
                             auto_power_view.Add_Info($"Max : {lst_power.Max()}");
                             auto_power_view.Add_Info($"Min : {lst_power.Min()}");
                             Alarm_Manager.Instance.Occurred(En_Alarm_List.AL_0940_TARGET_POWER_ERROR);
-                            Step = AblationSteps.S5999_AUTO_POWER_END;
+                            Step = AblationSteps.S6000_MOVE_STAY_POSITION;
                         }
                         break;
                     }
@@ -1558,9 +1693,20 @@
                     }
                 case AblationSteps.S5420_LASER_ON:
                     {
-                        if (equipment.scanner.Set_Laser_On())
+                        if (equipment.process.ablation.MotorX.MotionComplete && equipment.process.ablation.MotorZ.MotionComplete)
                         {
-                            Step = AblationSteps.S5430_LASER_ON_CHECK;
+                            if (equipment.process.ablation.Get_Is_Position_X_Power_Meter() && equipment.process.ablation.Get_Is_Position_Z_Power_Meter())
+                            {
+                                if (equipment.scanner.Set_Laser_On())
+                                {
+                                    auto_power_view.Add_Info($"Laser On.");
+                                    Step = AblationSteps.S5430_LASER_ON_CHECK;
+                                }
+                            }
+                            else
+                            {
+                                Step = AblationSteps.S0000_WAIT;
+                            }
                         }
                         break;
                     }
@@ -1641,7 +1787,7 @@
                         {
                             //alarm.
                             Alarm_Manager.Instance.Occurred(En_Alarm_List.AL_0942_POWER_COUNT_IS_EMPTY);
-                            Step = AblationSteps.S5999_AUTO_POWER_END;
+                            Step = AblationSteps.S6000_MOVE_STAY_POSITION;
                         }
 
                         double averager = lst_power.Average();
@@ -1658,7 +1804,7 @@
                             auto_power_view.Add_Info($"Max : {lst_power.Max()}");
                             auto_power_view.Add_Info($"Min : {lst_power.Min()}");
 
-                            Step = AblationSteps.S5999_AUTO_POWER_END;
+                            Step = AblationSteps.S6000_MOVE_STAY_POSITION;
                         }
                         else
                         {
@@ -1684,7 +1830,7 @@
                                 auto_power_view.Add_Info($"Max : {lst_power.Max()}");
                                 auto_power_view.Add_Info($"Min : {lst_power.Min()}");
                                 Alarm_Manager.Instance.Occurred(En_Alarm_List.AL_0941_RECIPE_POWER_ERROR);
-                                Step = AblationSteps.S5999_AUTO_POWER_END;
+                                Step = AblationSteps.S6000_MOVE_STAY_POSITION;
                             }
                         }
                         break;
@@ -1710,6 +1856,55 @@
                         Step = AblationSteps.S5410_RECIPE_POWER_SET;
                         break;
                     }
+                case AblationSteps.S6000_MOVE_STAY_POSITION:
+                    {
+                        double position = Get_Scanner_Z_A1_Stay_Position();
+
+                        if (MotorZ.Move_Absolute_Pos(position, 500))
+                        {
+                            Step = AblationSteps.S6010_LASER_OFF;
+                        }
+                        break;
+                    }
+                case AblationSteps.S6010_LASER_OFF:
+                    {
+                        if (equipment.scanner.Set_Laser_Off())
+                        {
+                            Step = AblationSteps.S6020_LASER_OFF_CHECK;
+                        }
+                        break;
+                    }
+                case AblationSteps.S6020_LASER_OFF_CHECK:
+                    {
+                        if (!equipment.sm.Get_Bit(Input_Memory_Address.Laser_Active))
+                        {
+                            auto_power_view.Add_Info($"Lsaer Off");
+                            Step = AblationSteps.S6100_MOVE_WAIT;
+                        }
+                        else
+                        {
+                            Step = AblationSteps.S6010_LASER_OFF;
+                        }
+                        break;
+                    }
+                case AblationSteps.S6100_MOVE_WAIT:
+                    {
+                        double position = Get_Scanner_Z_A1_Stay_Position();
+
+                        if (MotorZ.MotionComplete)
+                        {
+                            if (MotorZ.Is_Inposition(position, equipment.Setting.Inposition_Offset))
+                            {
+                                auto_power_view.Add_Info($"Scanner Stay Position Move");
+                                Step = AblationSteps.S5999_AUTO_POWER_END;
+                            }
+                            else
+                            {
+                                Step = AblationSteps.S6000_MOVE_STAY_POSITION;
+                            }
+                        }
+                        break;
+                    }
                 case AblationSteps.S5999_AUTO_POWER_END:
                     {
                         Parameter_Power parameter = equipment.Power_Parameter.Clone();

--
Gitblit v1.9.3