首次上传
This commit is contained in:
@@ -0,0 +1,75 @@
|
||||
using Aitex.Core.RT.Log;
|
||||
using Aitex.Core.RT.Routine;
|
||||
using Aitex.Core.RT.SCCore;
|
||||
|
||||
namespace SicModules.LLs.Routines
|
||||
{
|
||||
public class LoadRotationHomeOffsetRoutine : LoadLockBaseRoutine
|
||||
{
|
||||
enum RoutineStep
|
||||
{
|
||||
MoveRelativeHome,
|
||||
TimeDelay,
|
||||
WaitMoveDone,
|
||||
MoveHomeOffset,
|
||||
TimeDelay2,
|
||||
WaitMoveDone2,
|
||||
}
|
||||
private float _homeOffset;
|
||||
|
||||
public LoadRotationHomeOffsetRoutine()
|
||||
{
|
||||
Name = "Home";
|
||||
}
|
||||
|
||||
public override Result Start(params object[] objs)
|
||||
{
|
||||
Reset();
|
||||
|
||||
_homeOffset = (float)SC.GetConfigItem($"LoadLock.LoadRotation.HomeOffset").DoubleValue;
|
||||
|
||||
Notify("Start");
|
||||
|
||||
return Result.RUN;
|
||||
}
|
||||
|
||||
public override Result Monitor()
|
||||
{
|
||||
try
|
||||
{
|
||||
if (SC.GetValue<bool>($"System.IsSimulatorMode"))
|
||||
{
|
||||
return Result.DONE;
|
||||
}
|
||||
|
||||
MoveRelativeHome((int)RoutineStep.MoveRelativeHome, 10);
|
||||
TimeDelay((int)RoutineStep.TimeDelay, 3);
|
||||
WaitLoadRotationDone((int)RoutineStep.WaitMoveDone, 60);
|
||||
|
||||
//取消Offset
|
||||
//MoveLoadRotationHomeOffset((int)RoutineStep.MoveHomeOffset, _homeOffset, 10);
|
||||
//TimeDelay((int)RoutineStep.TimeDelay2, 1);
|
||||
//WaitLoadRotationDone((int)RoutineStep.WaitMoveDone2, 60);
|
||||
}
|
||||
catch (RoutineBreakException)
|
||||
{
|
||||
return Result.RUN;
|
||||
}
|
||||
catch (RoutineFaildException ex)
|
||||
{
|
||||
LOG.Error(ex.ToString());
|
||||
return Result.FAIL;
|
||||
}
|
||||
|
||||
Notify("Finished");
|
||||
|
||||
return Result.DONE;
|
||||
}
|
||||
|
||||
public override void Abort()
|
||||
{
|
||||
base.Abort();
|
||||
}
|
||||
|
||||
}
|
||||
}
|
||||
Reference in New Issue
Block a user