Commit 86a2e69c 张东亮

agv交互时未收到脱离信号不关门,手动关门时自动结束agv流程

1 个父辈 9e56b906
......@@ -271,7 +271,7 @@ namespace DeviceLibrary
break;
case MoveStep.AGV_Out04:
AGVMoveInfo.NextMoveStep(MoveStep.AGV_Out05);
Line.LineRun("n", true, 2);
Line.LineRun("n", true, 10);
AGVMoveInfo.log($"收到AGV的{NodeStatus.RequestLeave}信号,允许出料");
break;
case MoveStep.AGV_Out05:
......@@ -303,7 +303,7 @@ namespace DeviceLibrary
AGVMoveInfo.NextMoveStep(MoveStep.AGV_In03);
RobotManage.mainMachine.SetStatus(NodeStatus.MayEnter);
CylinderMove(AGVMoveInfo, IO_Type.StringFix_Bottom, IO_Type.StringFix_Top, IO_VALUE.LOW);
Line.LineRun("n", false, 2);
Line.LineRun("n", false, 10);
AGVMoveInfo.log($"收到AGV的{NodeStatus.RequestEnter}信号,无料串,允许进料");
}
else if (curnode.status == NodeStatus.RequestLeave)
......@@ -311,12 +311,12 @@ namespace DeviceLibrary
AGVMoveInfo.NextMoveStep(MoveStep.AGV_Out03);
RobotManage.mainMachine.SetStatus(NodeStatus.MayLeave);
CylinderMove(AGVMoveInfo, IO_Type.StringFix_Bottom, IO_Type.StringFix_Top, IO_VALUE.LOW);
Line.LineRun("n", true, 2);
Line.LineRun("n", true, 10);
AGVMoveInfo.log($"收到AGV的{NodeStatus.RequestLeave}信号,有料串,允许出料");
}
else if (curnode.status.Equals(NodeStatus.RequsetDock))
{
if(IOValue(IO_Type.StringDoor_Open).Equals(IO_VALUE.HIGH))
if (IOValue(IO_Type.StringDoor_Open).Equals(IO_VALUE.HIGH))
{
RobotManage.mainMachine.SetStatus(NodeStatus.MayDock);
}
......@@ -331,10 +331,14 @@ namespace DeviceLibrary
}
else if (AGVMoveInfo.IsTimeOut())
{
if (StringDoor.isAtBOTTOM)
{
AGVMoveInfo.NextMoveStep(MoveStep.AGV_CloseDoor);
CloseDoor(AGVMoveInfo);
AGVMoveInfo.log($"收到脱离脱离信号超时,关闭折叠门");
}
}
break;
case MoveStep.AGV_CloseDoor:
AGVMoveInfo.EndMove();
......
支持 Markdown 格式
你添加了 0 到此讨论。请谨慎行事。
Finish editing this message first!