| 12345678910111213141516171819202122232425262728293031323334353637383940414243444546474849505152535455565758596061626364656667686970717273747576777879808182838485868788899091929394959697989910010110210310410510610710810911011111211311411511611711811912012112212312412512612712812913013113213313413513613713813914014114214314414514614714814915015115215315415515615715815916016116216316416516616716816917017117217317417517617717817918018118218318418518618718818919019119219319419519619719819920020120220320420520620720820921021121221321421521621721821922022122222322422522622722822923023123223323423523623723823924024124224324424524624724824925025125225325425525625725825926026126226326426526626726826927027127227327427527627727827928028128228328428528628728828929029129229329429529629729829930030130230330430530630730830931031131231331431531631731831932032132232332432532632732832933033133233333433533633733833934034134234334434534634734834935035135235335435535635735835936036136236336436536636736836937037137237337437537637737837938038138238338438538638738838939039139239339439539639739839940040140240340440540640740840941041141241341441541641741841942042142242342442542642742842943043143243343443543643743843944044144244344444544644744844945045145245345445545645745845946046146246346446546646746846947047147247347447547647747847948048148248348448548648748848949049149249349449549649749849950050150250350450550650750850951051151251351451551651751851952052152252352452552652752852953053153253353453553653753853954054154254354454554654754854955055155255355455555655755855956056156256356456556656756856957057157257357457557657757857958058158258358458558658758858959059159259359459559659759859960060160260360460560660760860961061161261361461561661761861962062162262362462562662762862963063163263363463563663763863964064164264364464564664764864965065165265365465565665765865966066166266366466566666766866967067167267367467567667767867968068168268368468568668768868969069169269369469569669769869970070170270370470570670770870971071171271371471571671771871972072172272372472572672772872973073173273373473573673773873974074174274374474574674774874975075175275375475575675775875976076176276376476576676776876977077177277377477577677777877978078178278378478578678778878979079179279379479579679779879980080180280380480580680780880981081181281381481581681781881982082182282382482582682782882983083183283383483583683783883984084184284384484584684784884985085185285385485585685785885986086186286386486586686786886987087187287387487587687787887988088188288388488588688788888989089189289389489589689789889990090190290390490590690790890991091191291391491591691791891992092192292392492592692792892993093193293393493593693793893994094194294394494594694794894995095195295395495595695795895996096196296396496596696796896997097197297397497597697797897998098198298398498598698798898999099199299399499599699799899910001001100210031004100510061007100810091010101110121013101410151016101710181019102010211022102310241025102610271028102910301031103210331034103510361037103810391040104110421043104410451046104710481049105010511052105310541055105610571058105910601061106210631064106510661067106810691070107110721073107410751076107710781079108010811082108310841085108610871088108910901091109210931094109510961097109810991100110111021103110411051106110711081109111011111112111311141115111611171118111911201121112211231124112511261127112811291130113111321133113411351136113711381139114011411142114311441145114611471148114911501151115211531154115511561157115811591160116111621163116411651166116711681169117011711172117311741175117611771178117911801181118211831184118511861187118811891190119111921193119411951196119711981199120012011202120312041205120612071208120912101211121212131214121512161217121812191220122112221223122412251226122712281229123012311232123312341235123612371238123912401241124212431244124512461247124812491250125112521253125412551256125712581259126012611262126312641265126612671268126912701271127212731274127512761277127812791280128112821283128412851286128712881289129012911292129312941295129612971298129913001301130213031304130513061307130813091310131113121313131413151316131713181319132013211322132313241325132613271328132913301331133213331334133513361337133813391340134113421343134413451346134713481349135013511352135313541355135613571358135913601361136213631364136513661367136813691370137113721373137413751376137713781379138013811382138313841385 | 
							- using Aitex.Core.RT.Device;
 
- using Aitex.Core.RT.Fsm;
 
- using Aitex.Core.RT.Log;
 
- using Aitex.Core.RT.SCCore;
 
- using Aitex.Core.Util;
 
- using Aitex.Core.Utilities;
 
- using MECF.Framework.Common.Beckhoff.AxisProvider;
 
- using MECF.Framework.Common.Equipment;
 
- using MECF.Framework.Common.RecipeCenter;
 
- using MECF.Framework.Common.Utilities;
 
- using PunkHPX8_Core;
 
- using PunkHPX8_RT.Backends;
 
- using PunkHPX8_RT.Devices.AXIS;
 
- using PunkHPX8_RT.Devices.Facilities;
 
- using PunkHPX8_RT.Devices.SRD;
 
- using System;
 
- using System.Collections.Generic;
 
- using System.Linq;
 
- using System.Reflection;
 
- using System.Text;
 
- using System.Threading;
 
- using System.Threading.Tasks;
 
- using System.Timers;
 
- using System.Windows.Threading;
 
- using Aitex.Core.RT.Routine;
 
- namespace PunkHPX8_RT.Modules.SRD
 
- {
 
-     /// <summary>
 
-     /// RunWafer状态机
 
-     /// </summary>
 
-     public class RunWaferRecipeStateMachine : Entity, IEntity
 
-     {
 
-         #region 常量 
 
-         private const int MAX_ARM_HOME_RETRIES = 3;
 
-         /// <summary>
 
-         /// 旋转增加时长
 
-         /// </summary>
 
-         private const int ROTATION_PLUS_TIME = 10;
 
-         /// <summary>
 
-         /// ROTATION电机转速比例
 
-         /// </summary>
 
-         private const int SPEED_RATIO = 10;
 
-         #endregion
 
-         #region 内部变量
 
-         /// <summary>
 
-         /// 模块名称
 
-         /// </summary>
 
-         private string _module;
 
-         /// <summary>
 
-         /// Arm Axis
 
-         /// </summary>
 
-         private JetAxisBase _armAxis;
 
-         /// <summary>
 
-         /// Rotation Axis
 
-         /// </summary>
 
-         private JetAxisBase _rotationAxis;
 
-         /// <summary>
 
-         /// SRD Common
 
-         /// </summary>
 
-         private SrdCommonDevice _srdCommon;
 
-         /// <summary>
 
-         /// Total SRD
 
-         /// </summary>
 
-         private TotalSRDDevice _totalSRDDevice;
 
-         /// <summary>
 
-         /// 另外SRD实例 
 
-         /// </summary>
 
-         private SRDEntity _otherSrdEntity;
 
-         /// <summary>
 
-         /// Loader Common
 
-         /// </summary>
 
-         private SystemFacilities _systemFacilities;
 
-         /// <summary>
 
-         /// Arm是否Home
 
-         /// </summary>
 
-         private bool _armIsHomed;
 
-         /// <summary>
 
-         /// Arm重试次数
 
-         /// </summary>
 
-         private int _armRetryTimes = 0;
 
-         /// <summary>
 
-         /// ARM正在执行Home
 
-         /// </summary>
 
-         private bool _armHoming = false;
 
-         /// <summary>
 
-         /// 是否正在用水
 
-         /// </summary>
 
-         private bool _isUsingWater = false;
 
-         /// <summary>
 
-         /// Recipe
 
-         /// </summary>
 
-         private SrdRecipe _srdRecipe;
 
-         /// <summary>
 
-         /// 记时
 
-         /// </summary>
 
-         private int _enterTime;
 
-         /// <summary>
 
-         /// Diverting Flow时长
 
-         /// </summary>
 
-         private int _divertingFlowCheckTimeSpan;
 
-         /// <summary>
 
-         /// Pooling Flow时长
 
-         /// </summary>
 
-         private int _poolingFlowCheckTimeSpan;
 
-         /// <summary>
 
-         /// Washing Flow时长
 
-         /// </summary>
 
-         private int _washingFlowCheckTimeSpan;
 
-         /// <summary>
 
-         /// SRD rotation Provider对象
 
-         /// </summary>
 
-         private BeckhoffProviderAxis _rotationProviderAxis;
 
-         /// <summary>
 
-         /// SRD arm Provider对象
 
-         /// </summary>
 
-         private BeckhoffProviderAxis _armProviderAxis;
 
-         /// <summary>
 
-         /// 转换增加的时间
 
-         /// </summary>
 
-         private int _rotationPlusSecond = ROTATION_PLUS_TIME;
 
-         /// <summary>
 
-         /// N2 Enabled
 
-         /// </summary>
 
-         private bool _n2Enabled = false;
 
-         /// <summary>
 
-         /// Dry速度
 
-         /// </summary>
 
-         private int _drySpeed;
 
-         /// <summary>
 
-         /// exhaust进入时间
 
-         /// </summary>
 
-         private int _exhaustFanTime;
 
-         /// <summary>
 
-         /// 旋转停止时间
 
-         /// </summary>
 
-         private int _rotationStopTime;
 
-         /// <summary>
 
-         /// 是否执行Rotation Stop
 
-         /// </summary>
 
-         private bool _isExecuteRotationStop;
 
-         /// <summary>
 
-         /// Wafer Presence Accel/Decel比例 
 
-         /// </summary>
 
-         private int _waferPresenceCheckAccelDecelPercentage;
 
-         /// <summary>
 
-         /// Wafer Presence Speed
 
-         /// </summary>
 
-         private int _waferPresenceSpeedInRPMs;
 
-         /// <summary>
 
-         /// Wafer Presence distance
 
-         /// </summary>
 
-         private int _waferPresenceDistance;
 
-         /// <summary>
 
-         /// 状态机进入时间
 
-         /// </summary>
 
-         private int _startTime;
 
-         /// <summary>
 
-         /// Wafer Presence Test功能是否启用
 
-         /// </summary>
 
-         private bool _presenceTestEnabled;
 
-         /// <summary>
 
-         /// PresenceTest记录次数
 
-         /// </summary>
 
-         private int _presenceTestCount;
 
-         /// <summary>
 
-         /// 当前次数
 
-         /// </summary>
 
-         private int _currentCount;
 
-         /// <summary>
 
-         /// Rinse时间=Max(FrontRinseTime, BackRinseTime) 单位s
 
-         /// </summary>
 
-         private double _rinseTime;
 
-         /// <summary>
 
-         /// Rinse中另一个水阀开关状态
 
-         /// </summary>
 
-         private bool _isAnotherWaterOn;
 
-         /// <summary>
 
-         /// PresenceTest是否完成
 
-         /// </summary>
 
-         private bool _isTestComplete = true;
 
-         /// <summary>
 
-         /// Rotation是否执行Position
 
-         /// </summary>
 
-         private bool _isRotationExecutePosition = false;
 
-         /// <summary>
 
-         /// PresenceTest进入时间
 
-         /// </summary>
 
-         private int _presenceTestEnterTime;
 
-         #endregion
 
-         #region 属性
 
-         /// <summary>
 
-         /// 状态
 
-         /// </summary>
 
-         public string State { get { return ((RunWaferState)fsm.State).ToString(); } }
 
-         #endregion
 
-         /// <summary>
 
-         /// 构造函数
 
-         /// </summary>
 
-         /// <param name="name"></param>
 
-         public RunWaferRecipeStateMachine(string module) 
 
-         {
 
-             _module = module;
 
-             this.fsm = new StateMachine($"{module}_RunWaferStateMachine", (int)RunWaferState.RunWafer_Complete, 10);
 
-             fsm.EnableRepeatedMsg(true);           
 
-             AnyStateTransition(RunWaferMsg.Init, EnterRunWaferStart, RunWaferState.RunWafer_Start);
 
-             AnyStateTransition(RunWaferMsg.Error, EnterError, RunWaferState.Error);
 
-             Transition(RunWaferState.RunWafer_Start, RunWaferMsg.RunWafer_Start, RunWaferStartCheckStatus, RunWaferState.RunWafer_CheckFacilities);
 
-             Transition(RunWaferState.RunWafer_CheckFacilities, FSM_MSG.TIMER, CheckFacilities, RunWaferState.RunWafer_PreparingExhaustOff);
 
-             Transition(RunWaferState.RunWafer_PreparingExhaustOff, FSM_MSG.TIMER, PreparingExhaustOff, RunWaferState.RunWafer_WaitExhaustOff);
 
-             Transition(RunWaferState.RunWafer_WaitExhaustOff, FSM_MSG.TIMER, WaitExhaustOff, RunWaferState.RunWafer_EngageChuckVacuum);
 
-             Transition(RunWaferState.RunWafer_EngageChuckVacuum, FSM_MSG.TIMER, EngageChuckVacuum, RunWaferState.RunWafer_CheckVacuum);
 
-             Transition(RunWaferState.RunWafer_CheckVacuum, FSM_MSG.TIMER, CheckVacuum, RunWaferState.RunWafer_CloseTheDoor);
 
-             Transition(RunWaferState.RunWafer_CloseTheDoor, FSM_MSG.TIMER,CloseDoor,RunWaferState.RunWafer_CheckDoorClosed);
 
-             Transition(RunWaferState.RunWafer_CheckDoorClosed, FSM_MSG.TIMER, CheckDoorClosed, RunWaferState.RunWafer_ArmToHome);
 
-             Transition(RunWaferState.RunWafer_ArmToHome, FSM_MSG.TIMER,ArmToHome, RunWaferState.RunWafer_Diverting_CheckArmHome);
 
-             Transition(RunWaferState.RunWafer_Diverting_CheckArmHome, FSM_MSG.TIMER, CheckArmHome, RunWaferState.RunWafer_Diverting_CheckOtherSRD);
 
-             Transition(RunWaferState.RunWafer_Diverting_CheckOtherSRD, FSM_MSG.TIMER, CheckOtherSRD, RunWaferState.RunWafer_Diverting_WaterOn);
 
-             Transition(RunWaferState.RunWafer_Diverting_WaterOn, FSM_MSG.TIMER, WaterOn, RunWaferState.RunWafer_Diverting_WithFlowCheck);
 
-             Transition(RunWaferState.RunWafer_Diverting_WithFlowCheck, FSM_MSG.TIMER, CheckFlow, RunWaferState.RunWafer_Washing_ArmToCenter);
 
-             Transition(RunWaferState.RunWafer_Washing_ArmToCenter, FSM_MSG.TIMER, ArmToCenter, RunWaferState.RunWafer_Washing_CheckArmCenter);
 
-             Transition(RunWaferState.RunWafer_Washing_CheckArmCenter, FSM_MSG.TIMER, CheckArmToCenter, RunWaferState.RunWafer_Washing_PoolingFrontSide);
 
-             Transition(RunWaferState.RunWafer_Washing_PoolingFrontSide, FSM_MSG.TIMER, PoolingFrontSideWaterOn, RunWaferState.RunWafer_Washing_PoolingWithFlowCheck);
 
-             Transition(RunWaferState.RunWafer_Washing_PoolingWithFlowCheck, FSM_MSG.TIMER, PoolingCheckFlow, RunWaferState.RunWafer_Washing_StartRotation);
 
-             Transition(RunWaferState.RunWafer_Washing_StartRotation, FSM_MSG.TIMER, StartRotation, RunWaferState.RunWafer_Washing_PreFlowCheck);
 
-             Transition(RunWaferState.RunWafer_Washing_PreFlowCheck, FSM_MSG.TIMER, WashingPreFlowCheck, RunWaferState.RunWafer_Washing_Finished);
 
-             Transition(RunWaferState.RunWafer_Washing_Finished, FSM_MSG.TIMER, WashingFinished, RunWaferState.RunWafer_Drying_PreN2Time);
 
-             Transition(RunWaferState.RunWafer_Drying_PreN2Time, FSM_MSG.TIMER, CheckArmMotion, RunWaferState.RunWafer_Drying_ExhaustFanDelay);
 
-             Transition(RunWaferState.RunWafer_Drying_ExhaustFanDelay, FSM_MSG.TIMER, ExhaustFanDelay, RunWaferState.RunWafer_Drying_N2On);
 
-             Transition(RunWaferState.RunWafer_Drying_N2On, FSM_MSG.TIMER, N2On, RunWaferState.RunWafer_Drying_PreWaferPresenceCheck);
 
-             Transition(RunWaferState.RunWafer_Drying_PreWaferPresenceCheck, FSM_MSG.TIMER, PreWaferPresenceCheck, RunWaferState.RunWafer_Drying_WaferPresenceCheck);
 
-             Transition(RunWaferState.RunWafer_Drying_WaferPresenceCheck, FSM_MSG.TIMER, WaferPresenceCheck, RunWaferState.RunWafer_Drying_PostN2Time);
 
-             Transition(RunWaferState.RunWafer_Drying_PostN2Time, FSM_MSG.TIMER, PostN2Time, RunWaferState.RunWafer_Drying_CheckRotationFinished);
 
-             Transition(RunWaferState.RunWafer_Drying_CheckRotationFinished, FSM_MSG.TIMER, CheckRotationFinished, RunWaferState.RunWafer_CheckArmHome);
 
-             Transition(RunWaferState.RunWafer_CheckArmHome, FSM_MSG.TIMER, LastCheckArmHomed, RunWaferState.RunWafer_Complete);
 
-             //PresenceTest
 
-             Transition(RunWaferState.RunWafer_Complete, RunWaferMsg.PreWaferPresenceCheck, RunWaferStartCheckStatus, RunWaferState.RunWafer_Drying_PreWaferPresenceCheck);
 
-             EnumLoop<RunWaferState>.ForEach((item) => { fsm.MapState((int)item, item.ToString()); });
 
-             EnumLoop<RunWaferMsg>.ForEach((item) => { fsm.MapMessage((int)item, item.ToString()); });
 
-         }
 
-         private bool EnterError(object param)
 
-         {
 
-             
 
-             //关闭风扇
 
-             if (_srdCommon.CommonData.ExhaustOn)
 
-             {
 
-                 bool result = _srdCommon.N2OffAction("", null);
 
-                 if (!result)
 
-                 {
 
-                     LOG.WriteLog(eEvent.ERR_SRD, _module, "EnterError: Exhaust Off is failed");
 
-                 }
 
-             }
 
-             //关闭WaterAbove
 
-             if (_srdCommon.CommonData.WaterAbove)
 
-             {
 
-                 bool result = _srdCommon.WaterAboveOff();
 
-                 if (!result)
 
-                 {
 
-                     LOG.WriteLog(eEvent.INFO_SRD, _module, "EnterError: Water Above Off is failed");
 
-                 }
 
-             }
 
-             //关闭WaterBelow
 
-             if (_srdCommon.CommonData.WaterBelow)
 
-             {
 
-                 bool result = _srdCommon.WaterBelowOff();
 
-                 if (!result)
 
-                 {
 
-                     LOG.WriteLog(eEvent.INFO_SRD, _module, "EnterError: Water Below Off is failed");
 
-                 }
 
-             }
 
-             return true;
 
-         }
 
-         private bool EnterRunWaferStart(object param)
 
-         {
 
-             _isRotationExecutePosition = false;
 
-             return true;
 
-         }       
 
-         #region 状态方法
 
-         /// <summary>
 
-         /// 启动
 
-         /// </summary>
 
-         /// <param name="param"></param>
 
-         /// <returns></returns>
 
-         private bool RunWaferStartCheckStatus(object param)
 
-         {
 
-             
 
-             _startTime = Environment.TickCount;
 
-             if(param!=null)
 
-             {
 
-                 object[] parameters= (object[])param;
 
-                 _srdRecipe=(SrdRecipe)parameters[0];
 
-             }
 
-             if(_srdRecipe==null)
 
-             {
 
-                 PostMsg(RunWaferMsg.Error);
 
-                 LOG.WriteLog(eEvent.ERR_SRD, _module, "srd recipe is null");
 
-                 return false;
 
-             }
 
-             _armAxis = DEVICE.GetDevice<JetAxisBase>($"{_module}.Arm");
 
-             if(!_armAxis.IsHomed)
 
-             {
 
-                 PostMsg(RunWaferMsg.Error);
 
-                 LOG.WriteLog(eEvent.ERR_SRD, _module, "Arm is not homed");
 
-                 return false;
 
-             }
 
-             _rotationAxis = DEVICE.GetDevice<JetAxisBase>($"{_module}.Rotation");
 
-             if (!_rotationAxis.IsHomed)
 
-             {
 
-                 PostMsg(RunWaferMsg.Error);
 
-                 LOG.WriteLog(eEvent.ERR_SRD, _module, "Rotation is not homed");
 
-                 return false;
 
-             }
 
-             _srdCommon = DEVICE.GetDevice<SrdCommonDevice>($"{_module}.Common");
 
-             _totalSRDDevice = DEVICE.GetDevice<TotalSRDDevice>("SRD");
 
-             if (_srdCommon.IsWaferPresence)
 
-             {
 
-                 if (_srdCommon.WaferPresence != "WellPlaced")
 
-                 {
 
-                     PostMsg(RunWaferMsg.Error);
 
-                     LOG.WriteLog(eEvent.ERR_SRD, _module, "Wafer Presence is not WellPlaced");
 
-                     return false;
 
-                 }
 
-             }
 
-             else
 
-             {
 
-                 LOG.WriteLog(eEvent.INFO_SRD, _module, "Wafer Presence Test has been ignored");
 
-             }
 
-                                 
 
-             if(SC.ContainsItem("SRD.SRDRotationPlusSecond"))
 
-             {
 
-                 _rotationPlusSecond = SC.GetValue<int>("SRD.SRDRotationPlusSecond");
 
-             }
 
-             if(SC.ContainsItem("SRD.N2Enabled"))
 
-             {
 
-                 _n2Enabled = SC.GetValue<bool>("SRD.N2Enabled");
 
-             }
 
-             //Wafer Presence Test
 
-             if (SC.ContainsItem($"SRD.{_module}EnablePresenceCheckvalue"))
 
-             {
 
-                 _presenceTestEnabled = SC.GetValue<bool>($"SRD.{_module}EnablePresenceCheckvalue");
 
-             }
 
-             _systemFacilities = DEVICE.GetDevice<SystemFacilities>("System.Facilities");
 
-             string otherSRD = _module == "SRD1" ? "SRD2" : "SRD1";
 
-             _otherSrdEntity = Singleton<RouteManager>.Instance.GetModule<SRDEntity>(otherSRD);
 
-             _rotationProviderAxis = BeckhoffAxisProviderManager.Instance.GetAxisProvider($"{_module}.Rotation");
 
-             if (_rotationProviderAxis == null)
 
-             {
 
-                 PostMsg(RunWaferMsg.Error);
 
-                 LOG.WriteLog(eEvent.ERR_SRD, _module, $"{_module}.Rotation Provider is not exist");
 
-                 return false;
 
-             }
 
-             _armProviderAxis = BeckhoffAxisProviderManager.Instance.GetAxisProvider($"{_module}.Arm");
 
-             if (_armProviderAxis == null)
 
-             {
 
-                 PostMsg(RunWaferMsg.Error);
 
-                 LOG.WriteLog(eEvent.ERR_SRD, _module, $"{_module}.Arm Provider is not exist");
 
-                 return false;
 
-             }
 
-             _waferPresenceCheckAccelDecelPercentage = SC.GetValue<int>("SRD.WaferPresenceCheckAccelDecelPercentage");
 
-             _waferPresenceSpeedInRPMs = SC.GetValue<int>("SRD.WaferPresenceCheckSpeedInRPMs");
 
-             _waferPresenceDistance = SC.GetValue<int>("SRD.WaferPresenceCheckDistanceInDegrees");
 
-             return true;
 
-         }
 
-         /// <summary>
 
-         /// 检查Facilities
 
-         /// </summary>
 
-         /// <param name="param"></param>
 
-         /// <returns></returns>
 
-         private bool CheckFacilities(object param)
 
-         {
 
-             if (_srdCommon.CommonData.FluidContainment)
 
-             {
 
-                 LOG.WriteLog(eEvent.ERR_SRD, _module, "Fluid Containment sensor is On"); 
 
-                 PostMsg(RunWaferMsg.Error);
 
-                 return false;
 
-             }
 
-             if(!_systemFacilities.SrdDiEnable)
 
-             {
 
-                 LOG.WriteLog(eEvent.ERR_SRD, _module, "Load DI Is Disable");
 
-                 PostMsg(RunWaferMsg.Error);
 
-                 return false;
 
-             }
 
-             return true;
 
-         }
 
-         /// <summary>
 
-         /// 关闭Exhaust风机
 
-         /// </summary>
 
-         /// <param name="param"></param>
 
-         /// <returns></returns>
 
-         private bool PreparingExhaustOff(object param)
 
-         {
 
-             bool result = _srdCommon.N2OffAction("", null);
 
-             if (!result)
 
-             {
 
-                 LOG.WriteLog(eEvent.ERR_SRD, _module, "Preparing Exhaust Off is failed");
 
-                 PostMsg(RunWaferMsg.Error);
 
-                 return false;
 
-             }                 
 
-             return true;
 
-         }
 
-         /// <summary>
 
-         /// 等待Exhaust风机关闭状态
 
-         /// </summary>
 
-         /// <param name="param"></param>
 
-         /// <returns></returns>
 
-         private bool WaitExhaustOff(object param)
 
-         {
 
-             if (_srdCommon.Status==RState.Failed||_srdCommon.Status==RState.Timeout)
 
-             {
 
-                 LOG.WriteLog(eEvent.ERR_SRD, _module, "Waiting Exhaust Off is failed");
 
-                 PostMsg(RunWaferMsg.Error);
 
-                 return false;
 
-             }
 
-             return _srdCommon.Status == RState.End && !_srdCommon.CommonData.ExhaustOn;
 
-         }
 
-         /// <summary>
 
-         /// Chuck Vacuum
 
-         /// </summary>
 
-         /// <param name="param"></param>
 
-         /// <returns></returns>
 
-         private bool EngageChuckVacuum(object param)
 
-         {
 
-             if (_srdCommon.IsWaferPresence)
 
-             {
 
-                 bool result = _srdCommon.ChuckVacuumOnAction("", null);
 
-                 if (!result)
 
-                 {
 
-                     LOG.WriteLog(eEvent.ERR_SRD, _module, "Chuck Vacuum On Action is failed");
 
-                     PostMsg(RunWaferMsg.Error);
 
-                 }
 
-                 return result;
 
-             }
 
-             else
 
-             {
 
-                 LOG.WriteLog(eEvent.INFO_SRD, _module, "EngageChuckVacuum has been ignored");
 
-                 return true;
 
-             }
 
-                         
 
-         }
 
-         /// <summary>
 
-         /// 检查真空状态
 
-         /// </summary>
 
-         /// <param name="param"></param>
 
-         /// <returns></returns>
 
-         private bool CheckVacuum(object param)
 
-         {
 
-             if (_srdCommon.IsWaferPresence)
 
-             {
 
-                 if (_srdCommon.Status == RState.Failed || _srdCommon.Status == RState.Timeout)
 
-                 {
 
-                     LOG.WriteLog(eEvent.ERR_SRD, _module, "Check Vacuum is failed");
 
-                     PostMsg(RunWaferMsg.Error);
 
-                     return false;
 
-                 }
 
-                 return _srdCommon.Status == RState.End && !_srdCommon.CommonData.ChuckVacuum;
 
-             }
 
-             else
 
-             {
 
-                 LOG.WriteLog(eEvent.INFO_SRD, _module, "CheckVacuum has been ignored");
 
-                 return true;
 
-             }
 
-             
 
-         }
 
-         /// <summary>
 
-         /// Close Door
 
-         /// </summary>
 
-         /// <param name="param"></param>
 
-         /// <returns></returns>
 
-         private bool CloseDoor(object param)
 
-         {
 
-             if (_srdCommon.CommonData.DoorOpened)
 
-             {
 
-                 bool result = _srdCommon.DoorCloseAction("", null);
 
-                 if (!result)
 
-                 {
 
-                     LOG.WriteLog(eEvent.ERR_SRD, _module, "Door Close Action is failed");
 
-                     PostMsg(RunWaferMsg.Error);
 
-                     return result;
 
-                 }
 
-             }           
 
-             return true;
 
-         }
 
-         /// <summary>
 
-         /// 检验DoorClosed
 
-         /// </summary>
 
-         /// <param name="param"></param>
 
-         /// <returns></returns>
 
-         private bool CheckDoorClosed(object param)
 
-         {
 
-             if (_srdCommon.Status == RState.Failed || _srdCommon.Status == RState.Timeout)
 
-             {
 
-                 LOG.WriteLog(eEvent.ERR_SRD, _module, "Check Door Closed is failed");
 
-                 PostMsg(RunWaferMsg.Error);
 
-                 return false;
 
-             }
 
-             return _srdCommon.Status == RState.End && _srdCommon.CommonData.DoorClosed;
 
-         }
 
-         /// <summary>
 
-         /// Arm To Home
 
-         /// </summary>
 
-         /// <returns></returns>
 
-         private bool ArmToHome(object param)
 
-         {
 
-             if (!_armHoming)
 
-             {
 
-                 _armAxis.Home(false);
 
-                 _armHoming = true;
 
-                 return false;
 
-             }
 
-             else
 
-             {
 
-                 if(_armAxis.Status != RState.End)
 
-                 {
 
-                     return false;
 
-                 }
 
-             }
 
-             _armHoming = false;
 
-             _armIsHomed = _armAxis.IsHomed;
 
-             return true;
 
-         }
 
-         /// <summary>
 
-         /// 检验ARM,发现失败,则重试
 
-         /// </summary>
 
-         /// <param name="param"></param>
 
-         /// <returns></returns>
 
-         private bool CheckArmHome(object param)
 
-         {
 
-             if (_armIsHomed)
 
-             {
 
-                 return true;
 
-             }
 
-             else
 
-             {
 
-                 if(_armRetryTimes<MAX_ARM_HOME_RETRIES)
 
-                 {
 
-                     if (!_armHoming)
 
-                     {
 
-                         LOG.WriteLog(eEvent.INFO_SRD, _module, $"Arm Home Retry Home {_armRetryTimes + 1} times");
 
-                         bool result = _armAxis.Home(false);
 
-                         if (result)
 
-                         {
 
-                             _armHoming = true;    
 
-                         }
 
-                         _armRetryTimes++;
 
-                         return false;
 
-                     }
 
-                     else
 
-                     {
 
-                         if(_armAxis.IsHomed&&_armAxis.Status==RState.End)
 
-                         {
 
-                             _armRetryTimes = 0;
 
-                             _armHoming = false;
 
-                             return true;
 
-                         }
 
-                         return false;
 
-                     }
 
-                 }
 
-                 else
 
-                 {
 
-                     LOG.WriteLog(eEvent.ERR_SRD, _module, $"Arm Home Retry Home {_armRetryTimes + 1} times is over {MAX_ARM_HOME_RETRIES}");
 
-                     PostMsg(RunWaferMsg.Error);
 
-                     return false;
 
-                 }
 
-             }
 
-         }
 
-         /// <summary>
 
-         /// 检验另外一个SRD是否在用水
 
-         /// </summary>
 
-         /// <param name="param"></param>
 
-         /// <returns></returns>
 
-         private bool CheckOtherSRD(object param)
 
-         {
 
-             if (_otherSrdEntity == null)
 
-             {
 
-                 return true;
 
-             }
 
-             return !_otherSrdEntity.IsUsingWater;
 
-         }
 
-         /// <summary>
 
-         /// 打开Above water
 
-         /// </summary>
 
-         /// <param name="param"></param>
 
-         /// <returns></returns>
 
-         private bool WaterOn(object param)
 
-         {
 
-             if (_srdRecipe.FrontDivertTime>0)
 
-             {
 
-                 if(_srdRecipe.FrontDivertTime>_srdRecipe.DivertPlusPoolDelay)
 
-                 {
 
-                     _divertingFlowCheckTimeSpan = _srdRecipe.DivertPlusPoolDelay * 1000;
 
-                 }
 
-                 else
 
-                 {
 
-                     _divertingFlowCheckTimeSpan = _srdRecipe.FrontDivertTime*1000;
 
-                 }
 
-                 if (!_srdCommon.CommonData.WaterAbove)
 
-                 {
 
-                     bool result = _srdCommon.WaterAboveOn();
 
-                     if (result)
 
-                     {
 
-                         LOG.WriteLog(eEvent.INFO_SRD, _module, "Water Above On");
 
-                         _isUsingWater = true;
 
-                         _enterTime = Environment.TickCount;
 
-                     }
 
-                     else
 
-                     {
 
-                         LOG.WriteLog(eEvent.ERR_SRD, _module, "Water Above On is failed");
 
-                         PostMsg(RunWaferMsg.Error);
 
-                     }
 
-                     return result;
 
-                 }                 
 
-                 return false;
 
-             }
 
-             else
 
-             {
 
-                 return true;
 
-             }
 
-         }
 
-         /// <summary>
 
-         /// 检验水压
 
-         /// </summary>
 
-         /// <param name="param"></param>
 
-         /// <returns></returns>
 
-         private bool CheckFlow(object param)
 
-         {
 
-             if (_srdRecipe.FrontDivertTime==0)
 
-             {
 
-                 return true;
 
-             }
 
-             else
 
-             {
 
-                 int ticks = Environment.TickCount - _enterTime;
 
-                 if(ticks<=_divertingFlowCheckTimeSpan)
 
-                 {
 
-                     if(_totalSRDDevice.WaterPressure>_srdRecipe.MaxDivertPlusPoolPressure)
 
-                     {
 
-                         LOG.WriteLog(eEvent.ERR_SRD, _module,$"Water Pressure {_totalSRDDevice} is over {_srdRecipe.MaxDivertPlusPoolPressure}");
 
-                         PostMsg(RunWaferMsg.Error);
 
-                         return false;
 
-                     }
 
-                 }
 
-                 else
 
-                 {
 
-                     if (ticks >= _srdRecipe.FrontDivertTime*1000)
 
-                     {
 
-                         if (_srdCommon.CommonData.WaterAbove)
 
-                         {
 
-                             bool result = _srdCommon.WaterAboveOff();
 
-                                                
 
-                             if (result)
 
-                             {
 
-                                 LOG.WriteLog(eEvent.INFO_SRD, _module, "Water Above off");
 
-                             }
 
-                             else
 
-                             {
 
-                                 LOG.WriteLog(eEvent.ERR_SRD, _module, "Water Above On is failed");
 
-                                 PostMsg(RunWaferMsg.Error);
 
-                             }
 
-                             return result;
 
-                         }                      
 
-                     }
 
-                 }
 
-             }
 
-             return false;
 
-         }
 
-         /// <summary>
 
-         /// Arm运动至Center
 
-         /// </summary>
 
-         /// <param name="param"></param>
 
-         /// <returns></returns>
 
-         private bool ArmToCenter(object param)
 
-         {
 
-             bool result= _armAxis.PositionStation("Center");
 
-             if(!result)
 
-             {
 
-                 LOG.WriteLog(eEvent.ERR_SRD, _module, "Arm to Center is failed");
 
-                 PostMsg(RunWaferMsg.Error);
 
-             }
 
-             return result;
 
-         }
 
-         /// <summary>
 
-         /// check Arm是否运动至Center
 
-         /// </summary>
 
-         /// <param name="param"></param>
 
-         /// <returns></returns>
 
-         private bool CheckArmToCenter(object param)
 
-         {
 
-             if (_armAxis.Status==RState.End)
 
-             {
 
-                 return true;
 
-             }
 
-             else if(_armAxis.Status==RState.Failed)
 
-             {
 
-                 LOG.WriteLog(eEvent.ERR_SRD, _module, "Check Arm to Center is failed");
 
-                 PostMsg(RunWaferMsg.Error);
 
-                 return false;
 
-             }
 
-             return false;
 
-         }
 
-         /// <summary>
 
-         /// 打开Above water
 
-         /// </summary>
 
-         /// <param name="param"></param>
 
-         /// <returns></returns>
 
-         private bool PoolingFrontSideWaterOn(object param)
 
-         {
 
-             if (_srdRecipe.FrontPoolTime > 0)
 
-             {
 
-                 if (_srdRecipe.FrontPoolTime > _srdRecipe.DivertPlusPoolDelay)
 
-                 {
 
-                     _poolingFlowCheckTimeSpan = _srdRecipe.DivertPlusPoolDelay * 1000;
 
-                 }
 
-                 else
 
-                 {
 
-                     _poolingFlowCheckTimeSpan = _srdRecipe.FrontDivertTime * 1000;
 
-                 }
 
-                 if (!_srdCommon.CommonData.WaterAbove)
 
-                 {
 
-                     bool result = _srdCommon.WaterAboveOn();
 
-                     if (result)
 
-                     {
 
-                         LOG.WriteLog(eEvent.INFO_SRD, _module, "Water Above On");
 
-                         _enterTime = Environment.TickCount;
 
-                         if (_isUsingWater)
 
-                         {
 
-                             _isUsingWater = true;
 
-                         }
 
-                     }
 
-                     else
 
-                     {
 
-                         LOG.WriteLog(eEvent.ERR_SRD, _module, "Water Above On is failed");
 
-                         PostMsg((int)RunWaferMsg.Error);
 
-                     }
 
-                     return result;
 
-                 }
 
-                 return true;
 
-             }
 
-             else
 
-             {
 
-                 return true;
 
-             }
 
-         }
 
-         /// <summary>
 
-         /// 检验水压
 
-         /// </summary>
 
-         /// <param name="param"></param>
 
-         /// <returns></returns>
 
-         private bool PoolingCheckFlow(object param)
 
-         {
 
-             if (_srdRecipe.FrontPoolTime == 0)
 
-             {
 
-                 return true;
 
-             }
 
-             else
 
-             {
 
-                 int ticks = Environment.TickCount - _enterTime;
 
-                 if (ticks <= _poolingFlowCheckTimeSpan)
 
-                 {
 
-                     if (_totalSRDDevice.WaterPressure > _srdRecipe.MaxWashPressure)
 
-                     {
 
-                         LOG.WriteLog(eEvent.ERR_SRD, _module, $"Water Pressure {_totalSRDDevice.WaterPressure} is over {_srdRecipe.MaxWashPressure}");
 
-                         PostMsg((int)RunWaferMsg.Error);
 
-                         return false;
 
-                     }
 
-                     if (_totalSRDDevice.WaterPressure < _srdRecipe.MinWaterPressure)
 
-                     {
 
-                         LOG.WriteLog(eEvent.ERR_SRD, _module, $"Water Pressure {_totalSRDDevice.WaterPressure} is less {_srdRecipe.MinWaterPressure}");
 
-                         PostMsg((int)RunWaferMsg.Error);
 
-                         return false;
 
-                     }
 
-                 }
 
-                 else
 
-                 {
 
-                     if (ticks >= _srdRecipe.FrontPoolTime * 1000)
 
-                     {
 
-                         return true;
 
-                     }
 
-                 }
 
-             }
 
-             return false;
 
-         }
 
-         /// <summary>
 
-         /// 开始旋转
 
-         /// </summary>
 
-         /// <param name="param"></param>
 
-         /// <returns></returns>
 
-         private bool StartRotation(object param)
 
-         {
 
-             if (_srdCommon.CommonData.DoorOpened)
 
-             {
 
-                 LOG.WriteLog(eEvent.ERR_SRD, _module, "Door is not closed. Can't do rotation");
 
-                 PostMsg(RunWaferMsg.Error);
 
-                 return false;
 
-             }
 
-             double _scale = _rotationProviderAxis.ScaleFactor;
 
-             bool above = _srdRecipe.FrontRinseTime > _srdRecipe.BackRinseTime;
 
-             int timespan = above ? _srdRecipe.FrontRinseTime : _srdRecipe.BackRinseTime;
 
-             //rinse 目标位置 
 
-             double rinsePosition = timespan * BeckhoffVelocityUtil.ConvertVelocityToDegPerSecondByRPM(_srdRecipe.RinseSpeed);
 
-             //dry目标位置
 
-             double dryPosition = BeckhoffVelocityUtil.ConvertVelocityToDegPerSecondByRPM(_srdRecipe.DrySpeed) * _srdRecipe.BackN2DryTime;
 
-             //为了让 rotation 不停止,增加了旋转时间(覆盖Arm运动时间)
 
-             double plusPosition = BeckhoffVelocityUtil.ConvertVelocityToDegPerSecondByRPM(_srdRecipe.DrySpeed) * _rotationPlusSecond;
 
-             int targetPosition = (int)Math.Round((rinsePosition + dryPosition + plusPosition) * _scale, 0);
 
-             int rotationSpeed = (int)Math.Round(_scale * BeckhoffVelocityUtil.ConvertVelocityToDegPerSecondByRPM(_srdRecipe.RinseSpeed),0);
 
-             _drySpeed= (int)Math.Round(_scale * BeckhoffVelocityUtil.ConvertVelocityToDegPerSecondByRPM(_srdRecipe.DrySpeed * SPEED_RATIO), 0);
 
-             bool result= _rotationAxis.ProfilePosition(targetPosition, rotationSpeed * SPEED_RATIO, 0, 0);
 
-             if(!result)
 
-             {
 
-                 LOG.WriteLog(eEvent.ERR_SRD, _module, "Start Rotation is failed");
 
-                 PostMsg(RunWaferMsg.Error);
 
-                 return false;
 
-             }
 
-             LOG.WriteLog(eEvent.INFO_SRD, _module, "Start Rotation");
 
-             //如果BackRinseTime大,则先开WaterBelow后开WaterAbove        
 
-             if (_srdRecipe.BackRinseTime>_srdRecipe.FrontRinseTime)
 
-             {
 
-                 _rinseTime = _srdRecipe.BackRinseTime;
 
-                 //关闭WaterAbove
 
-                 if (_srdCommon.CommonData.WaterAbove)
 
-                 {                    
 
-                     if (!_srdCommon.WaterAboveOff())
 
-                     {
 
-                         LOG.WriteLog(eEvent.ERR_SRD, _module, "Water Above Off is failed");
 
-                         PostMsg((int)RunWaferMsg.Error);
 
-                         return false;
 
-                     }
 
-                     LOG.WriteLog(eEvent.INFO_SRD, _module, "Water Above Off");
 
-                 }
 
-                 //打开WaterBelow
 
-                 if (!_srdCommon.CommonData.WaterBelow)
 
-                 {
 
-                     if (!_srdCommon.WaterBelowOn())
 
-                     {
 
-                         LOG.WriteLog(eEvent.ERR_SRD, _module, "Water Below On is failed");
 
-                         PostMsg((int)RunWaferMsg.Error);
 
-                         return false;
 
-                     }
 
-                     LOG.WriteLog(eEvent.INFO_SRD, _module, "Water Below On");
 
-                 } 
 
-                 //Rinse开始时间
 
-                 _enterTime = Environment.TickCount;
 
-                 //另一个水阀状态变为未开(即WaterAbove)
 
-                 _isAnotherWaterOn = false;
 
-                 //计算水压检测滞后时间
 
-                 if (_srdRecipe.BackRinseTime > _srdRecipe.FlowCheckDelay)
 
-                 {
 
-                     _washingFlowCheckTimeSpan = _srdRecipe.FlowCheckDelay * 1000;
 
-                 }
 
-                 else
 
-                 {
 
-                     _washingFlowCheckTimeSpan = _srdRecipe.BackRinseTime * 1000;
 
-                 }
 
-                 
 
-                 return true;
 
-             }
 
-             else
 
-             {
 
-                 _rinseTime = _srdRecipe.FrontRinseTime;
 
-                 //如果FrontRinseTime大,则先开WaterAbove后开WaterBelow
 
-                 //打开WaterAbove
 
-                 if (!_srdCommon.CommonData.WaterAbove)
 
-                 {
 
-                     if (!_srdCommon.WaterAboveOn())
 
-                     {
 
-                         LOG.WriteLog(eEvent.ERR_SRD, _module, "Water Above Off is failed");
 
-                         PostMsg((int)RunWaferMsg.Error);
 
-                         return false;
 
-                     }
 
-                     LOG.WriteLog(eEvent.INFO_SRD, _module, "Water Above On");
 
-                 }
 
-                 //关闭WaterBelow
 
-                 if (_srdCommon.CommonData.WaterBelow)
 
-                 {
 
-                     //打开WaterBelow
 
-                     if (!_srdCommon.WaterBelowOff())
 
-                     {
 
-                         LOG.WriteLog(eEvent.ERR_SRD, _module, "Water Below On is failed");
 
-                         PostMsg((int)RunWaferMsg.Error);
 
-                         return false;
 
-                     }
 
-                     LOG.WriteLog(eEvent.INFO_SRD, _module, "Water Below Off");
 
-                 }
 
-                 //另一个水阀状态变为未开(即WaterBelow)
 
-                 _isAnotherWaterOn = false;
 
-                 //Rinse开始时间
 
-                 _enterTime = Environment.TickCount;
 
-                 //计算水压检测滞后时间
 
-                 if (_srdRecipe.FrontRinseTime > _srdRecipe.FlowCheckDelay)
 
-                 {
 
-                     _washingFlowCheckTimeSpan = _srdRecipe.FlowCheckDelay * 1000;
 
-                 }
 
-                 else
 
-                 {
 
-                     _washingFlowCheckTimeSpan = _srdRecipe.BackRinseTime * 1000;
 
-                 }
 
-                 return true;
 
-             }
 
-         }
 
-         /// <summary>
 
-         /// 检验水压
 
-         /// </summary>
 
-         /// <param name="param"></param>
 
-         /// <returns></returns>
 
-         private bool WashingPreFlowCheck(object param)
 
-         {
 
-             int ticks = Environment.TickCount - _enterTime;
 
-             //打开另一个未开的水阀
 
-             if(!_isAnotherWaterOn)
 
-             {
 
-                 //延迟abs(BackRinseTime - FrontRinseTime)秒打开另一个水阀
 
-                 if (_srdRecipe.BackRinseTime > _srdRecipe.FrontRinseTime)
 
-                 {
 
-                     //若BackRinseTime > FrontRinseTime,则延迟BackRinseTime - FrontRinseTime秒打开Water Above
 
-                     if (ticks >= _rinseTime*1000 - _srdRecipe.FrontRinseTime*1000 && !_srdCommon.CommonData.WaterAbove)
 
-                     {
 
-                         bool result = _srdCommon.WaterAboveOn();
 
-                         if (!result)
 
-                         {
 
-                             LOG.WriteLog(eEvent.ERR_SRD, _module, "Water Above Off is failed");
 
-                             PostMsg((int)RunWaferMsg.Error);
 
-                             return false;
 
-                         }
 
-                         _isAnotherWaterOn = true;
 
-                         LOG.WriteLog(eEvent.INFO_SRD, _module, "Water Above On");
 
-                     }
 
-                 }
 
-                 else
 
-                 {
 
-                     //若FrontRinseTime > BackRinseTime,则延迟FrontRinseTime - BackRinseTime秒打开Water Below
 
-                     if (ticks >= _rinseTime * 1000 - _srdRecipe.BackRinseTime * 1000 && !_srdCommon.CommonData.WaterBelow)
 
-                     {
 
-                         bool result = _srdCommon.WaterBelowOn();
 
-                         if (!result)
 
-                         {
 
-                             LOG.WriteLog(eEvent.ERR_SRD, _module, "Water Below On is failed");
 
-                             PostMsg((int)RunWaferMsg.Error);
 
-                             return false;
 
-                         }
 
-                         LOG.WriteLog(eEvent.INFO_SRD, _module, "Water Below On");
 
-                     }
 
-                 }
 
-             }
 
-                     
 
-             if (ticks >= _rinseTime * 1000)
 
-             {
 
-                 //达到RinseTime完成Wash
 
-                 return true;
 
-             }
 
-             else if (ticks > _washingFlowCheckTimeSpan)
 
-             {
 
-                 if (_totalSRDDevice.WaterPressure > _srdRecipe.MaxWashPressure)
 
-                 {
 
-                     LOG.WriteLog(eEvent.ERR_SRD, _module, $"Water Pressure {_totalSRDDevice.WaterPressure} is over {_srdRecipe.MaxWashPressure}");
 
-                     PostMsg((int)RunWaferMsg.Error);
 
-                     return false;
 
-                 }
 
-                 if (_totalSRDDevice.WaterPressure < _srdRecipe.MinWaterPressure)
 
-                 {
 
-                     LOG.WriteLog(eEvent.ERR_SRD, _module, $"Water Pressure {_totalSRDDevice.WaterPressure} is less {_srdRecipe.MinWaterPressure}");
 
-                     PostMsg((int)RunWaferMsg.Error);
 
-                     return false;
 
-                 }
 
-             }
 
-             else
 
-             {
 
-                 return false;
 
-             }
 
-             return false;
 
-         }
 
-         /// <summary>
 
-         /// Washing结束
 
-         /// </summary>
 
-         /// <param name="param"></param>
 
-         /// <returns></returns>
 
-         private bool WashingFinished(object param)
 
-         {
 
-             if (_srdCommon.CommonData.WaterAbove)
 
-             {
 
-                 if(!_srdCommon.WaterAboveOff())
 
-                 {
 
-                     LOG.WriteLog(eEvent.ERR_SRD, _module, "Water Above Off is failed");
 
-                     PostMsg(RunWaferMsg.Error);
 
-                     return false;
 
-                 }
 
-             }
 
-             if(_srdCommon.CommonData.WaterBelow)
 
-             {
 
-                 if(!_srdCommon.WaterBelowOff())
 
-                 {
 
-                     LOG.WriteLog(eEvent.ERR_SRD, _module, "Water Below Off is failed");
 
-                     PostMsg(RunWaferMsg.Error);
 
-                     return false;
 
-                 }
 
-             }
 
-             _isUsingWater = false;
 
-             if(_n2Enabled)
 
-             {
 
-                 bool result= _armAxis.PositionStation("Center");
 
-                 if(!result)
 
-                 {
 
-                     LOG.WriteLog(eEvent.ERR_SRD, _module, "Arm to Center is failed");
 
-                     PostMsg(RunWaferMsg.Error);
 
-                 }
 
-                 return result;
 
-             }
 
-             else
 
-             {
 
-                 bool result= _armAxis.PositionStation("Home");
 
-                 if (!result)
 
-                 {
 
-                     LOG.WriteLog(eEvent.ERR_SRD, _module, "Arm To Home is failed");
 
-                     PostMsg(RunWaferMsg.Error);
 
-                 }
 
-                 return result;
 
-             }
 
-         }
 
-         /// <summary>
 
-         /// 检验Arm是否运动到位
 
-         /// </summary>
 
-         /// <returns></returns>
 
-         private bool CheckArmMotion(object param)
 
-         {
 
-             //Arm是否运动到位
 
-             if (_armAxis.Status==RState.End)
 
-             {
 
-                 //调整速度为 drySpeed
 
-                 bool result= _rotationAxis.ChangeSpeed(_drySpeed);
 
-                 if(!result)
 
-                 {
 
-                     LOG.WriteLog(eEvent.ERR_SRD, _module, "Change Speed to Dry Speed is failed");
 
-                     return false;
 
-                 }
 
-                 if(_n2Enabled)
 
-                 {
 
-                     //todo 打开N2 Above和N2 Below
 
-                 }
 
-                 _exhaustFanTime = Environment.TickCount;
 
-                 return true;
 
-             }
 
-             else if(_armAxis.Status==RState.Failed)
 
-             {
 
-                 LOG.WriteLog(eEvent.ERR_SRD, _module, "Arm Axis Status is in Failed");
 
-                 PostMsg(RunWaferMsg.Error);
 
-                 return false;
 
-             }
 
-             return false;
 
-         }
 
-         /// <summary>
 
-         /// Exhaust delay
 
-         /// </summary>
 
-         /// <param name="param"></param>
 
-         /// <returns></returns>
 
-         private bool ExhaustFanDelay(object param)
 
-         {
 
-             int ticks = Environment.TickCount - _exhaustFanTime;
 
-             if (ticks >= _srdRecipe.ExhaustFanDelay * 1000)
 
-             {
 
-                 bool result = _srdCommon.N2On();
 
-                 if(!result)
 
-                 {
 
-                     LOG.WriteLog(eEvent.ERR_SRD, _module, "Exhaust On failed");
 
-                     PostMsg(RunWaferMsg.Error);
 
-                     return false;
 
-                 }
 
-                 _enterTime = Environment.TickCount;
 
-                 return true;
 
-             }
 
-             return false;
 
-         }
 
-         /// <summary>
 
-         /// N2 On
 
-         /// </summary>
 
-         /// <param name="param"></param>
 
-         /// <returns></returns>
 
-         private bool N2On(object param)
 
-         {
 
-             if (_n2Enabled)
 
-             {
 
-                 //todo 关闭N2Above和N2 Below
 
-             }
 
-             
 
-             int ticks = Environment.TickCount - _enterTime;
 
-             if(ticks > _srdRecipe.BackN2DryTime * 1000) return true;
 
-             return false;
 
-         }
 
-         /// <summary>
 
-         /// Pre WaferPresence Check
 
-         /// </summary>
 
-         /// <returns></returns>
 
-         private bool PreWaferPresenceCheck(object param)
 
-         {
 
-             if (!_isExecuteRotationStop)
 
-             { 
 
-                 //停止Rotation
 
-                 bool result= _rotationAxis.StopPositionOperation();
 
-                 LOG.WriteLog(eEvent.INFO_SRD, _module, "Stop Rotation is done");
 
-                 _rotationStopTime = Environment.TickCount;
 
-                 _isExecuteRotationStop = true;
 
-                 if(!result)
 
-                 {
 
-                     LOG.WriteLog(eEvent.ERR_SRD, _module, "Stop Rotation is failed");
 
-                     PostMsg(RunWaferMsg.Error);
 
-                 }
 
-             }
 
-             else
 
-             {
 
-                 int ticks=Environment.TickCount-_rotationStopTime;
 
-                 if(ticks>=5*1000)//固定时间5秒,确认Rotation是否已经停下
 
-                 {
 
-                     if(!_rotationAxis.IsRun && _rotationAxis.Status == RState.End)
 
-                     {
 
-                         _isExecuteRotationStop = false;
 
-                         return true;
 
-                     }
 
-                     else
 
-                     {
 
-                         LOG.WriteLog(eEvent.ERR_SRD, _module, "SRD Rotation Stop time span is over 5 seconds");
 
-                         PostMsg(RunWaferMsg.Error);
 
-                         return false;
 
-                     }
 
-                 }
 
-             }
 
-             return false;
 
-         }
 
-         /// <summary>
 
-         /// Wafer Presence Check
 
-         /// </summary>
 
-         /// <param name="param"></param>
 
-         /// <returns></returns>
 
-         private bool WaferPresenceCheck(object param)
 
-         {
 
-             double scale = _rotationProviderAxis.ScaleFactor;
 
-             int currentRotation = (int)Math.Round(_rotationAxis.MotionData.MotorPosition * scale, 0);
 
-             //Presence Test目标位置(单位为°)
 
-             int targetPosition = (int)Math.Round(scale * _waferPresenceDistance,0)+currentRotation;
 
-             //转速单位转换 RPM(r/min) to degree/s
 
-             double degree = BeckhoffVelocityUtil.ConvertVelocityToDegPerSecondByRPM(_waferPresenceSpeedInRPMs);
 
-             //Presence Test目标转速
 
-             int profileVelocity =(int)Math.Round(scale*degree,0);
 
-             //加速度
 
-             int acceleration = (int)Math.Round(_rotationAxis.ProfileAcceleration * _waferPresenceCheckAccelDecelPercentage / 100, 0);
 
-             //减速度
 
-             int deceleration = (int)Math.Round(_rotationAxis.ProfileDeceleration * _waferPresenceCheckAccelDecelPercentage / 100, 0);
 
-             if (!_isRotationExecutePosition)
 
-             {
 
-                 if (_srdCommon.CommonData.DoorOpened)
 
-                 {
 
-                     LOG.WriteLog(eEvent.ERR_SRD, _module, "Door is not closed. Can't do rotation");
 
-                     PostMsg(RunWaferMsg.Error);
 
-                     return false;
 
-                 }
 
-                 bool result = _rotationAxis.ProfilePosition(targetPosition, profileVelocity * SPEED_RATIO, acceleration, deceleration);
 
-                 if (!result)
 
-                 {
 
-                     LOG.WriteLog(eEvent.ERR_SRD, _module, "Start Rotation is failed");
 
-                     PostMsg(RunWaferMsg.Error);
 
-                 }
 
-                 _isRotationExecutePosition = true;
 
-                 if (_srdCommon.IsWaferPresence && _presenceTestEnabled)
 
-                 {
 
-                     //PresenceTest记录次数=(目标位置/目标转速)*1000ms /500ms
 
-                     _presenceTestCount = (int)Math.Floor(_waferPresenceDistance / degree * 1000 / 500);
 
-                     LOG.WriteLog(eEvent.INFO_SRD, _module, $"Presence Test Count is about {_presenceTestCount} times");
 
-                     //当前test次数归零
 
-                     _currentCount = 0;
 
-                     //开始计时
 
-                     _presenceTestEnterTime = Environment.TickCount;
 
-                     _isTestComplete = false;
 
-                     LOG.WriteLog(eEvent.INFO_SRD, _module, "Presence Test Timer is started");
 
-                 }
 
-                 return false;
 
-             }
 
-             else
 
-             {
 
-                 //PresenceTestEnable开启则进行测试
 
-                 if (!_isTestComplete && _srdCommon.IsWaferPresence && _presenceTestEnabled)
 
-                 {
 
-                     int ticks = Environment.TickCount - _presenceTestEnterTime;
 
-                     //500ms检测一次
 
-                     if(ticks >= 500)
 
-                     {
 
-                         if (_srdCommon.WaferPresence == "WellPlaced")
 
-                         {
 
-                             _currentCount++;
 
-                             LOG.WriteLog(eEvent.INFO_SRD, _module, $"The {_currentCount}th Presence Test is successful");
 
-                             //更新PresenceTestEnterTime
 
-                             _presenceTestEnterTime = Environment.TickCount;
 
-                             if(_currentCount >= _presenceTestCount)
 
-                             {
 
-                                 //PresenceTest通过                        
 
-                                 _isTestComplete = true;
 
-                                 LOG.WriteLog(eEvent.INFO_SRD, _module, $"The Presence Test of {_module} is all successful");
 
-                             }
 
-                             else
 
-                             {
 
-                                 return false;
 
-                             }
 
-                         }
 
-                         else
 
-                         {
 
-                             LOG.WriteLog(eEvent.ERR_SRD, _module, $"The {_currentCount + 1}th Presence Test is failed");
 
-                             LOG.WriteLog(eEvent.ERR_SRD, _module, $"The Presence Test of {_module} is failed");
 
-                             PostMsg(RunWaferMsg.Error);
 
-                             return false;
 
-                         }
 
-                     }
 
-                     else
 
-                     {
 
-                         return false;
 
-                     }
 
-                 }
 
-                 
 
-                 if (_rotationAxis.Status!=RState.End)
 
-                 {
 
-                     return false;
 
-                 }
 
-             }
 
-            
 
-             return true;
 
-         }
 
-         /// <summary>
 
-         /// Post N2 Time(Stop rotation ,home rotation)
 
-         /// </summary>
 
-         /// <param name="param"></param>
 
-         /// <returns></returns>
 
-         private bool PostN2Time(object param)
 
-         {           
 
-             bool homeResult = _rotationAxis.Home(false);
 
-             if(!homeResult)
 
-             {
 
-                 LOG.WriteLog(eEvent.ERR_SRD, _module, $"{_module}.Arm is not homed");
 
-                 PostMsg(RunWaferMsg.Error);
 
-                 return false;
 
-             }
 
-             return true;
 
-         }
 
-         /// <summary>
 
-         /// 检验Rotation是否Homed
 
-         /// </summary>
 
-         /// <param name="param"></param>
 
-         /// <returns></returns>
 
-         private bool CheckRotationFinished(object param)
 
-         {
 
-             //关闭排风扇
 
-             if (_srdCommon.CommonData.ExhaustOn && _srdCommon.Status != RState.Running)
 
-             {
 
-                 bool result1 = _srdCommon.N2OffAction("", null);
 
-                 if (!result1)
 
-                 {
 
-                     LOG.WriteLog(eEvent.ERR_SRD, _module, "Preparing Exhaust Off is failed");
 
-                     PostMsg(RunWaferMsg.Error);
 
-                 }
 
-             }
 
-             
 
-             bool result= _rotationAxis.IsHomed && _rotationAxis.Status == RState.End;
 
-             if(_rotationAxis.Status!=RState.Running)
 
-             {
 
-                 if(!_rotationAxis.IsHomed)
 
-                 {
 
-                     LOG.WriteLog(eEvent.ERR_SRD, _module, $"{_module}.rotation is not homed");
 
-                 }
 
-                 return true;
 
-             }
 
-             return false;
 
-         }
 
-         /// <summary>
 
-         /// 检验
 
-         /// </summary>
 
-         /// <param name="param"></param>
 
-         /// <returns></returns>
 
-         private bool LastCheckArmHomed(object param)
 
-         {
 
-             string currentLocation = _armAxis.CurrentStation;
 
-             bool armHomed= _armAxis.IsHomed;
 
-             if(!armHomed)
 
-             {
 
-                 LOG.WriteLog(eEvent.ERR_SRD, _module, $"{_module}.Arm is not homed");
 
-                 PostMsg(RunWaferMsg.Error);
 
-                 return false;
 
-             }
 
-             if (!currentLocation.Contains("Home"))
 
-             {
 
-                 LOG.WriteLog(eEvent.ERR_SRD, _module, $"{_module}.Arm is not in home station");
 
-                 PostMsg(RunWaferMsg.Error);
 
-                 return false;
 
-             }
 
-             LOG.WriteLog(eEvent.INFO_SRD, _module, $"Run Wafer State Machine 状态 {RunWaferState.RunWafer_Start}==>{RunWaferState.RunWafer_Complete} Total Time[{Environment.TickCount - _startTime}]");
 
-             return true;
 
-         }
 
-         #endregion
 
-         /// <summary>
 
-         /// 停止 
 
-         /// </summary>
 
-         public void Stop()
 
-         {           
 
-             base.Terminate();
 
-         }
 
-         public bool Check(int msg, out string reason, params object[] args)
 
-         {
 
-             reason = "";
 
-             return false;
 
-         }
 
-         #region State Msg枚举
 
-         public enum RunWaferState
 
-         {
 
-             None,
 
-             Error,
 
-             RunWafer_Start,
 
-             RunWafer_CheckFacilities,
 
-             RunWafer_PreparingExhaustOff,
 
-             RunWafer_WaitExhaustOff,
 
-             RunWafer_EngageChuckVacuum,
 
-             RunWafer_CheckVacuum,
 
-             RunWafer_CloseTheDoor,
 
-             RunWafer_CheckDoorClosed,
 
-             RunWafer_ArmToHome,
 
-             RunWafer_Diverting_CheckArmHome,
 
-             RunWafer_Diverting_CheckOtherSRD,
 
-             RunWafer_Diverting_WaterOn,
 
-             RunWafer_Diverting_WithFlowCheck,
 
-             RunWafer_Washing_ArmToCenter,
 
-             RunWafer_Washing_CheckArmCenter,
 
-             RunWafer_Washing_PoolingFrontSide,
 
-             RunWafer_Washing_PoolingWithFlowCheck,
 
-             RunWafer_Washing_StartRotation,
 
-             RunWafer_Washing_PreFlowCheck,
 
-             RunWafer_Washing_Finished,
 
-             RunWafer_Drying_PreN2Time,
 
-             RunWafer_Drying_ExhaustFanDelay,
 
-             RunWafer_Drying_N2On,
 
-             RunWafer_Drying_PreWaferPresenceCheck,
 
-             RunWafer_Drying_WaferPresenceCheck,
 
-             RunWafer_Drying_PostN2Time,
 
-             RunWafer_Drying_CheckRotationFinished,
 
-             RunWafer_CheckArmHome,
 
-             RunWafer_Complete
 
-         }
 
-         public enum RunWaferMsg
 
-         {
 
-             Init,
 
-             Error,
 
-             RunWafer_Start,
 
-             CheckFacilities,
 
-             PreparingExhaustOff,
 
-             WaitExhaustOff,
 
-             EngageChuckVacuum,
 
-             CloseTheDoor,
 
-             ArmToHome,
 
-             CheckOtherSRD,
 
-             DivertingWaterAboveOn,
 
-             ArmToCenter,
 
-             PoolingFrontWaterAboveOn,
 
-             StartRotation,
 
-             Washing_Finished,
 
-             N2On,
 
-             PreWaferPresenceCheck,
 
-             WaferPresenceCheck,
 
-             PostN2Time,
 
-             CheckArmHome,
 
-             Abort
 
-         }
 
-         #endregion
 
-     }
 
- }
 
 
  |