|
@@ -118,7 +118,10 @@ namespace Venus_RT.Modules.LPs
|
|
|
private LoadPortReadTagDataRoutine _readTag;
|
|
|
private LoadPortWriteTagDataRoutine _writeTag;
|
|
|
private LoadPortUnclampRoutine _unclamp;
|
|
|
- //private LoadPortUndockRoutine _undock;
|
|
|
+
|
|
|
+ private LoadPortDockRoutine _dock;
|
|
|
+ private LoadPortUnDockRoutine _undock;
|
|
|
+
|
|
|
private LoadPortLoadRoutine _load;
|
|
|
private LoadPortUnloadRoutine _unload;
|
|
|
|
|
@@ -170,7 +173,7 @@ namespace Venus_RT.Modules.LPs
|
|
|
_home = new LoadPortHomeRoutine(this);
|
|
|
//_closeDoor = new LoadPortCloseDoorRoutine(this);
|
|
|
_clamp = new LoadPortClampRoutine(this);
|
|
|
- //_dock = new LoadPortDockRoutine(this);
|
|
|
+ _dock = new LoadPortDockRoutine(this);
|
|
|
//_map = new LoadPortMapRoutine(this);
|
|
|
//_openDoor = new LoadPortOpenDoorRoutine(this);
|
|
|
_readCarrierId = new LoadPortReadCarrierIdRoutine(this);
|
|
@@ -178,7 +181,7 @@ namespace Venus_RT.Modules.LPs
|
|
|
_readTag = new LoadPortReadTagDataRoutine(this);
|
|
|
_writeTag = new LoadPortWriteTagDataRoutine(this);
|
|
|
_unclamp = new LoadPortUnclampRoutine(this);
|
|
|
- //_undock = new LoadPortUndockRoutine(this);
|
|
|
+ _undock = new LoadPortUnDockRoutine(this);
|
|
|
//_MapDT = new LoadPortGetMapInfoRoutine(this);
|
|
|
_load = new LoadPortLoadRoutine(this);
|
|
|
_unload = new LoadPortUnloadRoutine(this);
|
|
@@ -366,26 +369,22 @@ namespace Venus_RT.Modules.LPs
|
|
|
|
|
|
private bool FsmStartUndock(object[] param)
|
|
|
{
|
|
|
- QueueRoutine.Clear();
|
|
|
-
|
|
|
- QueueRoutine.Enqueue(_unload);
|
|
|
-
|
|
|
- _clamp.IsUnloadClamp = true;
|
|
|
- QueueRoutine.Enqueue(_clamp);
|
|
|
-
|
|
|
- RState ret = StartRoutine();
|
|
|
-
|
|
|
+ RState ret = StartRoutine(_undock);
|
|
|
if (ret == RState.Failed || ret == RState.End)
|
|
|
+ {
|
|
|
return false;
|
|
|
+ }
|
|
|
return ret == RState.Running;
|
|
|
}
|
|
|
|
|
|
private bool FsmStartDock(object[] param)
|
|
|
{
|
|
|
- //Result ret = StartRoutine(_dock);
|
|
|
- //if (ret == Result.FAIL || ret == Result.DONE)
|
|
|
+ RState ret = StartRoutine(_dock);
|
|
|
+ if (ret == RState.Failed || ret == RState.End)
|
|
|
+ {
|
|
|
return false;
|
|
|
- //return ret == Result.RUN;
|
|
|
+ }
|
|
|
+ return ret == RState.Running;
|
|
|
}
|
|
|
|
|
|
private bool FsmStartUnclamp(object[] param)
|