首次上传
This commit is contained in:
@@ -0,0 +1,286 @@
|
||||
using System;
|
||||
using System.Diagnostics;
|
||||
using Aitex.Core.RT.Device.Devices;
|
||||
using Aitex.Core.RT.Routine;
|
||||
using MECF.Framework.Common.Equipment;
|
||||
using SicModules.PMs.Routines.Base;
|
||||
|
||||
namespace SicModules.PMs.Routines
|
||||
{
|
||||
public class PMButttomSectionMoveRoutine : PMBaseRoutine
|
||||
{
|
||||
|
||||
//public IoGasConnector _ioGasConnector;
|
||||
//public IoLid _ioButtomLid;
|
||||
//public IoLidSwing _ioButtomSwing;
|
||||
//public IoBottomSection _ioButtomSection;
|
||||
|
||||
int _timeoutLid = 10;
|
||||
int _timeoutSwing = 10;
|
||||
int _timeoutGasConnector = 10;
|
||||
int _timeoutButtomSection = 10;
|
||||
|
||||
private bool _Open = true;
|
||||
|
||||
|
||||
private Stopwatch _swTimer = new Stopwatch();
|
||||
public int ElapsedTime
|
||||
{
|
||||
get { return _swTimer.IsRunning ? (int)(_swTimer.ElapsedMilliseconds / 1000) : 0; }
|
||||
}
|
||||
|
||||
enum RoutineStep
|
||||
{
|
||||
RoutineStep0,
|
||||
RoutineStep1,
|
||||
RoutineStep2,
|
||||
RoutineStep3,
|
||||
RoutineStep4,
|
||||
RoutineStep5,
|
||||
RoutineStep6,
|
||||
RoutineStep7,
|
||||
RoutineStep8,
|
||||
RoutineStep9,
|
||||
RoutineStep10,
|
||||
RoutineStepTime1,
|
||||
RoutineStepTime2,
|
||||
RoutineStepTime3,
|
||||
RoutineStepTime4,
|
||||
RoutineStepTime5,
|
||||
}
|
||||
|
||||
public PMButttomSectionMoveRoutine(ModuleName module, PMModule pm1) : base(module, pm1)
|
||||
{
|
||||
Module = module.ToString();
|
||||
Name = "MoveBottom";
|
||||
|
||||
//_ioGasConnector = DEVICE.GetDevice<IoGasConnector>($"{pm.Name}.{"GasConnector"}");
|
||||
//_ioButtomLid = DEVICE.GetDevice<IoLid>($"{pm.Name}.{"BottomLid"}");
|
||||
//_ioButtomSwing = DEVICE.GetDevice<IoLidSwing>($"{pm.Name}.{"BottomLidSwing"}");
|
||||
//_ioButtomSection = DEVICE.GetDevice<IoBottomSection>($"{pm.Name}.{"BottomSection"}");
|
||||
|
||||
//_timeoutLid = SC.GetValue<int>("PM.Motion.LidTimeout");
|
||||
//_timeoutSwing = SC.GetValue<int>("PM.Motion.LidSwingTimeout");
|
||||
//_timeoutGasConnector = SC.GetValue<int>("PM.Motion.GasConnectorTimeout");
|
||||
//_timeoutButtomSection = SC.GetValue<int>("PM.Motion.ButtomSectionUpTimeout");
|
||||
|
||||
|
||||
}
|
||||
|
||||
internal void Init(params object[] objs)
|
||||
{
|
||||
_Open = Boolean.Parse(objs[0].ToString());
|
||||
}
|
||||
|
||||
public override Result Start(params object[] objs)
|
||||
{
|
||||
_swTimer.Restart();
|
||||
Reset();
|
||||
Notify("Start");
|
||||
return Result.RUN;
|
||||
}
|
||||
|
||||
|
||||
public override Result Monitor()
|
||||
{
|
||||
try
|
||||
{
|
||||
return Result.DONE;
|
||||
//GasConnectorLoosen((int)RoutineStep.RoutineStep0, true, _timeoutGasConnector);
|
||||
|
||||
//if (_Open)
|
||||
//{
|
||||
// CheckLidTighten((int)RoutineStep.RoutineStep2, _ioButtomLid, "Bottom", false, _timeoutLid);
|
||||
// CheckLidSwingLock((int)RoutineStep.RoutineStep1, _ioButtomSwing, "BottomSwing", false, _timeoutSwing);
|
||||
// TimeDelay((int)RoutineStep.RoutineStep3, 1);
|
||||
// CheckButtomSectionUpDown((int)RoutineStep.RoutineStep4, _ioButtomSection, true, _timeoutButtomSection);
|
||||
//}
|
||||
//else
|
||||
//{
|
||||
// TimeDelay((int)RoutineStep.RoutineStep3, 1);
|
||||
// CheckButtomSectionUpDown((int)RoutineStep.RoutineStep4, _ioButtomSection, false, _timeoutButtomSection);
|
||||
// CheckLidSwingLock((int)RoutineStep.RoutineStep1, _ioButtomSwing, "BottomSwing", true, _timeoutSwing);
|
||||
// CheckLidTighten((int)RoutineStep.RoutineStep2, _ioButtomLid, "Bottom", true, _timeoutLid);
|
||||
//}
|
||||
}
|
||||
catch (RoutineBreakException)
|
||||
{
|
||||
return Result.RUN;
|
||||
}
|
||||
catch (RoutineFaildException ex)
|
||||
{
|
||||
if (ex.Message == "Timeout")
|
||||
{
|
||||
Notify("Timeout");
|
||||
}
|
||||
return Result.FAIL;
|
||||
}
|
||||
_swTimer.Stop();
|
||||
Notify("Finished");
|
||||
|
||||
return Result.DONE;
|
||||
}
|
||||
|
||||
|
||||
//protected void GasConnectorLoosen(int id, bool isLock, int timeout)
|
||||
//{
|
||||
// Tuple<bool, Result> ret = ExecuteAndWait(id, () =>
|
||||
// {
|
||||
// Notify($"Run GasConnector Tighten");
|
||||
|
||||
// if (!_ioGasConnector.SetGasConnector(true, out string reason))
|
||||
// {
|
||||
// return false;
|
||||
// }
|
||||
|
||||
// return true;
|
||||
// }, () =>
|
||||
// {
|
||||
// return isLock ? _ioGasConnector.GasConnectorTightenFeedback == true : _ioGasConnector.GasConnectorLoosenFeedback == true;
|
||||
|
||||
// }, timeout * 1000);
|
||||
|
||||
|
||||
// if (ret.Item1)
|
||||
// {
|
||||
// if (ret.Item2 == Result.FAIL)
|
||||
// {
|
||||
// throw (new RoutineFaildException());
|
||||
// }
|
||||
// else if (ret.Item2 == Result.TIMEOUT)
|
||||
// {
|
||||
// throw (new RoutineFaildException("Timeout"));
|
||||
// }
|
||||
// else
|
||||
// {
|
||||
// throw (new RoutineBreakException());
|
||||
// }
|
||||
// }
|
||||
//}
|
||||
|
||||
protected void CheckLidTighten(int id, IoLid cLid, string strLidName, bool isTighten, int timeout)
|
||||
{
|
||||
Tuple<bool, Result> ret = ExecuteAndWait(id, () =>
|
||||
{
|
||||
Notify(isTighten ? $"Run {strLidName} Tighten" : $"Run {strLidName} Loosen");
|
||||
|
||||
if (!cLid.SetLid(!isTighten, out string reason))
|
||||
{
|
||||
return false;
|
||||
}
|
||||
|
||||
return true;
|
||||
}, () =>
|
||||
{
|
||||
return isTighten ? cLid.TightenFaceback == true : cLid.LoosenFaceback == true;
|
||||
|
||||
}, timeout * 1000);
|
||||
|
||||
if (ret.Item1)
|
||||
{
|
||||
if (ret.Item2 == Result.FAIL)
|
||||
{
|
||||
throw (new RoutineFaildException());
|
||||
}
|
||||
else if (ret.Item2 == Result.TIMEOUT)
|
||||
{
|
||||
throw (new RoutineFaildException("Timeout"));
|
||||
}
|
||||
else
|
||||
{
|
||||
throw (new RoutineBreakException());
|
||||
}
|
||||
}
|
||||
}
|
||||
|
||||
protected void CheckLidSwingLock(int id, IoLidSwing cLidSwing, string strLidName, bool isLock, int timeout)
|
||||
{
|
||||
Tuple<bool, Result> ret = ExecuteAndWait(id, () =>
|
||||
{
|
||||
Notify(isLock ? $"Run {strLidName} SwingLock" : $"Run {strLidName} SwingUnLock");
|
||||
|
||||
if (!cLidSwing.SetLidSwing(isLock, out string reason))
|
||||
{
|
||||
return false;
|
||||
}
|
||||
|
||||
return true;
|
||||
}, () =>
|
||||
{
|
||||
return isLock ? cLidSwing.LidLockFaceback == true : cLidSwing.LidUnlockFaceback == true;
|
||||
|
||||
}, timeout * 1000);
|
||||
|
||||
|
||||
if (ret.Item1)
|
||||
{
|
||||
if (ret.Item2 == Result.FAIL)
|
||||
{
|
||||
throw (new RoutineFaildException());
|
||||
}
|
||||
else if (ret.Item2 == Result.TIMEOUT)
|
||||
{
|
||||
throw (new RoutineFaildException("Timeout"));
|
||||
}
|
||||
else
|
||||
{
|
||||
throw (new RoutineBreakException());
|
||||
}
|
||||
}
|
||||
}
|
||||
|
||||
//protected void CheckButtomSectionUpDown(int id, IoBottomSection cSection, bool toDown, int timeout)
|
||||
//{
|
||||
// Tuple<bool, Result> ret = ExecuteAndWait(id, () =>
|
||||
// {
|
||||
// if (toDown)
|
||||
// {
|
||||
// Notify( $"Run BottomSection Down");
|
||||
|
||||
// if (!cSection.MoveDown(out string reason))
|
||||
// {
|
||||
// return false;
|
||||
// }
|
||||
// }
|
||||
// else
|
||||
// {
|
||||
// Notify($"Run BottomSection Up");
|
||||
|
||||
// if (!cSection.MoveUp(out string reason))
|
||||
// {
|
||||
// return false;
|
||||
// }
|
||||
// }
|
||||
|
||||
// return true;
|
||||
// }, () =>
|
||||
// {
|
||||
// return toDown ? cSection.DownFaceback == true : cSection.UpFaceback == true;
|
||||
|
||||
// }, timeout * 1000);
|
||||
|
||||
|
||||
// if (ret.Item1)
|
||||
// {
|
||||
// if (ret.Item2 == Result.FAIL)
|
||||
// {
|
||||
// throw (new RoutineFaildException());
|
||||
// }
|
||||
// else if (ret.Item2 == Result.TIMEOUT)
|
||||
// {
|
||||
// throw (new RoutineFaildException("Timeout"));
|
||||
// }
|
||||
// else
|
||||
// {
|
||||
// throw (new RoutineBreakException());
|
||||
// }
|
||||
// }
|
||||
//}
|
||||
|
||||
|
||||
public override void Abort()
|
||||
{
|
||||
base.Abort();
|
||||
}
|
||||
}
|
||||
}
|
||||
Reference in New Issue
Block a user