2023-04-13 15:35:13 +08:00
|
|
|
|
using Aitex.Core.RT.Routine;
|
2023-03-03 15:42:13 +08:00
|
|
|
|
using Aitex.Core.RT.SCCore;
|
2023-04-13 15:35:13 +08:00
|
|
|
|
using SicModules.LLs.Routines.Base;
|
2023-03-03 15:42:13 +08:00
|
|
|
|
|
2023-04-13 15:35:13 +08:00
|
|
|
|
namespace SicModules.LLs.Routines
|
2023-03-03 15:42:13 +08:00
|
|
|
|
{
|
|
|
|
|
public class LoadLockLiftRoutine : LoadLockBaseRoutine
|
|
|
|
|
{
|
|
|
|
|
enum RoutineStep
|
|
|
|
|
{
|
|
|
|
|
LiftMove
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
private bool _pinUp;
|
|
|
|
|
private int _liftMoveTimeOut = 30;
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
public LoadLockLiftRoutine()
|
|
|
|
|
{
|
|
|
|
|
Name = "Lift Move";
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
public void Init(bool isUp)
|
|
|
|
|
{
|
|
|
|
|
_pinUp = isUp;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
public override Result Start(params object[] objs)
|
|
|
|
|
{
|
|
|
|
|
Reset();
|
|
|
|
|
|
|
|
|
|
_liftMoveTimeOut = SC.GetValue<int>("LoadLock.LiftMoveTimeOut");
|
|
|
|
|
Notify("Start");
|
|
|
|
|
return Result.RUN;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
public override Result Monitor()
|
|
|
|
|
{
|
|
|
|
|
try
|
|
|
|
|
{
|
|
|
|
|
LiftMove((int)RoutineStep.LiftMove, _pinUp, _liftMoveTimeOut);
|
|
|
|
|
}
|
|
|
|
|
catch (RoutineBreakException)
|
|
|
|
|
{
|
|
|
|
|
return Result.RUN;
|
|
|
|
|
}
|
|
|
|
|
catch (RoutineFaildException)
|
|
|
|
|
{
|
|
|
|
|
return Result.FAIL;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
Notify("Finished");
|
|
|
|
|
|
|
|
|
|
return Result.DONE;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
public override void Abort()
|
|
|
|
|
{
|
|
|
|
|
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
}
|
|
|
|
|
}
|