Commit 612feae2 刘韬

1

1 个父辈 63494615
...@@ -244,10 +244,14 @@ namespace DeviceLibrary ...@@ -244,10 +244,14 @@ namespace DeviceLibrary
break; break;
case MoveStep.TransplantMove_11: case MoveStep.TransplantMove_11:
MoveInfo.NextMoveStep(MoveStep.TransplantMove_12); MoveInfo.NextMoveStep(MoveStep.TransplantMove_12);
var AMH_TS_P2 = DeviceGroup.p2 - (MoveInfo.MoveParam.PlateH - 70) * Config.AMH_TS_PoToMM + MetrialGetRetry * 2 * Config.AMH_TS_PoToMM; int ReelHeight = MoveInfo.MoveParam.PlateH;
if (FixtureConfig.GetFixtureHeight(MoveInfo.MoveParam.PlateW, MoveInfo.MoveParam.PlateH, out int actualheight1))
ReelHeight = actualheight1;
var AMH_TS_P2 = DeviceGroup.p2 - (ReelHeight - 70) * Config.AMH_TS_PoToMM + MetrialGetRetry * 2 * Config.AMH_TS_PoToMM;
axis.AbsMove(MoveInfo, AMH_TS_P2, Config.AMH_TS_P1_speed); axis.AbsMove(MoveInfo, AMH_TS_P2, Config.AMH_TS_P1_speed);
IOMove(IO_Type.AMH_Sucker, IO_VALUE.HIGH); IOMove(IO_Type.AMH_Sucker, IO_VALUE.HIGH);
MoveInfo.log($"PlateH:{MoveInfo.MoveParam.PlateH},AMH_TS_P2:{AMH_TS_P2},MetrialGetRetry:{MetrialGetRetry}"); MoveInfo.log($"PlateH:{MoveInfo.MoveParam.PlateH},AMH_TS_P2:{AMH_TS_P2},ReelHeight:{ReelHeight},MetrialGetRetry:{MetrialGetRetry}");
break; break;
case MoveStep.TransplantMove_12: case MoveStep.TransplantMove_12:
MoveInfo.NextMoveStep(MoveStep.TransplantMove_13); MoveInfo.NextMoveStep(MoveStep.TransplantMove_13);
...@@ -304,12 +308,15 @@ namespace DeviceLibrary ...@@ -304,12 +308,15 @@ namespace DeviceLibrary
break; break;
case MoveStep.TransplantMove_21: case MoveStep.TransplantMove_21:
MoveInfo.NextMoveStep(MoveStep.TransplantMove_22); MoveInfo.NextMoveStep(MoveStep.TransplantMove_22);
AMH_TS_P2 = DeviceGroup.p3 - (MoveInfo.MoveParam.PlateH - 70) * Config.AMH_TS_PoToMM+ (MetrialGetRetry*2* Config.AMH_TS_PoToMM); ReelHeight = MoveInfo.MoveParam.PlateH;
if (FixtureConfig.GetFixtureHeight(MoveInfo.MoveParam.PlateW, MoveInfo.MoveParam.PlateH, out actualheight1))
ReelHeight = actualheight1;
AMH_TS_P2 = DeviceGroup.p3 - (ReelHeight - 70) * Config.AMH_TS_PoToMM+ (MetrialGetRetry*2* Config.AMH_TS_PoToMM);
axis.AbsMove(MoveInfo, AMH_TS_P2, Config.AMH_TS_P1_speed); axis.AbsMove(MoveInfo, AMH_TS_P2, Config.AMH_TS_P1_speed);
IOMove(IO_Type.AMH_Sucker, IO_VALUE.HIGH); IOMove(IO_Type.AMH_Sucker, IO_VALUE.HIGH);
MoveInfo.log($"PlateH:{MoveInfo.MoveParam.PlateH},AMH_TS_P2:{AMH_TS_P2},MetrialGetRetry:{MetrialGetRetry}"); MoveInfo.log($"PlateH:{MoveInfo.MoveParam.PlateH},AMH_TS_P2:{AMH_TS_P2},ReelHeight:{ReelHeight},MetrialGetRetry:{MetrialGetRetry}");
break; break;
case MoveStep.TransplantMove_22: case MoveStep.TransplantMove_22:
MoveInfo.NextMoveStep(MoveStep.TransplantMove_23); MoveInfo.NextMoveStep(MoveStep.TransplantMove_23);
axis.AbsMove(MoveInfo, Config.AMH_TS_P1, Config.AMH_TS_P1_speed); axis.AbsMove(MoveInfo, Config.AMH_TS_P1, Config.AMH_TS_P1_speed);
...@@ -360,9 +367,12 @@ namespace DeviceLibrary ...@@ -360,9 +367,12 @@ namespace DeviceLibrary
break; break;
case MoveStep.TransplantMove_25: case MoveStep.TransplantMove_25:
MoveInfo.NextMoveStep(MoveStep.TransplantMove_26); MoveInfo.NextMoveStep(MoveStep.TransplantMove_26);
AMH_TS_P2 = DeviceGroup.p2 - (MoveInfo.MoveParam.PlateH - 70) * Config.AMH_TS_PoToMM; ReelHeight = MoveInfo.MoveParam.PlateH;
if (FixtureConfig.GetFixtureHeight(MoveInfo.MoveParam.PlateW, MoveInfo.MoveParam.PlateH, out actualheight1))
ReelHeight = actualheight1;
AMH_TS_P2 = DeviceGroup.p2 - (ReelHeight - 70) * Config.AMH_TS_PoToMM;
axis.AbsMove(MoveInfo, AMH_TS_P2, Config.AMH_TS_P2_speed); axis.AbsMove(MoveInfo, AMH_TS_P2, Config.AMH_TS_P2_speed);
MoveInfo.log($"PlateH:{MoveInfo.MoveParam.PlateH},AMH_TS_P2:{AMH_TS_P2}"); MoveInfo.log($"PlateH:{MoveInfo.MoveParam.PlateH},AMH_TS_P2:{AMH_TS_P2},ReelHeight:{ReelHeight}");
break; break;
case MoveStep.TransplantMove_26: case MoveStep.TransplantMove_26:
MoveInfo.NextMoveStep(MoveStep.TransplantMove_27); MoveInfo.NextMoveStep(MoveStep.TransplantMove_27);
...@@ -409,10 +419,13 @@ namespace DeviceLibrary ...@@ -409,10 +419,13 @@ namespace DeviceLibrary
MoveInfo2.log("移栽气缸的前进"); MoveInfo2.log("移栽气缸的前进");
break; break;
case MoveStep.TransplantMove_02: case MoveStep.TransplantMove_02:
MoveInfo2.NextMoveStep(MoveStep.TransplantMove_03); MoveInfo2.NextMoveStep(MoveStep.TransplantMove_03);
var AMH_TS_P2 = DeviceGroup.p3 - (MoveInfo2.MoveParam.PlateH - 70) * Config.AMH_TS_PoToMM; int ReelHeight = MoveInfo.MoveParam.PlateH;
if (FixtureConfig.GetFixtureHeight(MoveInfo.MoveParam.PlateW, MoveInfo.MoveParam.PlateH, out int actualheight1))
ReelHeight = actualheight1;
var AMH_TS_P2 = DeviceGroup.p3 - (ReelHeight - 70) * Config.AMH_TS_PoToMM;
axis.AbsMove(MoveInfo2, AMH_TS_P2, Config.AMH_TS_P2_speed); axis.AbsMove(MoveInfo2, AMH_TS_P2, Config.AMH_TS_P2_speed);
MoveInfo2.log($"PlateH:{MoveInfo2.MoveParam.PlateH},AMH_TS_P2:{AMH_TS_P2}"); MoveInfo2.log($"PlateH:{MoveInfo2.MoveParam.PlateH},AMH_TS_P2:{AMH_TS_P2},ReelHeight:{ReelHeight}");
break; break;
case MoveStep.TransplantMove_03: case MoveStep.TransplantMove_03:
MoveInfo2.NextMoveStep(MoveStep.TransplantMove_04); MoveInfo2.NextMoveStep(MoveStep.TransplantMove_04);
......
...@@ -129,7 +129,7 @@ namespace DeviceLibrary ...@@ -129,7 +129,7 @@ namespace DeviceLibrary
if (stop && !trayInfo.HasLoad && IOValue(IO_Type.MI_Reel_Check).Equals(IO_VALUE.LOW)) if (stop && !trayInfo.HasLoad && IOValue(IO_Type.MI_Reel_Check).Equals(IO_VALUE.LOW))
{ {
MoveInfo.NextMoveStep(MoveStep.TrayStop_WaitLoadProcess); MoveInfo.NextMoveStep(MoveStep.TrayStop_07);
RemoteLoad remoteLoad = new RemoteLoad(); RemoteLoad remoteLoad = new RemoteLoad();
remoteLoad.Action = "TrayReady"; remoteLoad.Action = "TrayReady";
remoteLoad.RequestLoadInfo = new RequestLoadInfo(); remoteLoad.RequestLoadInfo = new RequestLoadInfo();
...@@ -147,7 +147,7 @@ namespace DeviceLibrary ...@@ -147,7 +147,7 @@ namespace DeviceLibrary
} }
else if (trayInfo.DestinationAddr == DeviceGroup.addr_1 && trayInfo.HasLoad && IOValue(IO_Type.MI_Reel_Check).Equals(IO_VALUE.HIGH)) else if (trayInfo.DestinationAddr == DeviceGroup.addr_1 && trayInfo.HasLoad && IOValue(IO_Type.MI_Reel_Check).Equals(IO_VALUE.HIGH))
{ {
MoveInfo.NextMoveStep(MoveStep.TrayStop_WaitLoadProcess); MoveInfo.NextMoveStep(MoveStep.TrayStop_07);
RemoteLoad remoteLoad = new RemoteLoad(); RemoteLoad remoteLoad = new RemoteLoad();
remoteLoad.Action = "TrayReady"; remoteLoad.Action = "TrayReady";
remoteLoad.RequestLoadInfo = new RequestLoadInfo(); remoteLoad.RequestLoadInfo = new RequestLoadInfo();
...@@ -205,6 +205,10 @@ namespace DeviceLibrary ...@@ -205,6 +205,10 @@ namespace DeviceLibrary
MoveInfo.NextMoveStep(MoveStep.TrayStop_04); MoveInfo.NextMoveStep(MoveStep.TrayStop_04);
} }
break; break;
case MoveStep.TrayStop_07:
MoveInfo.NextMoveStep(MoveStep.TrayStop_WaitLoadProcess);
Location.ToHigh(MoveInfo);
break;
case MoveStep.TrayStop_WaitLoadProcess: case MoveStep.TrayStop_WaitLoadProcess:
Msg.add("等待处理载荷",MsgLevel.info); Msg.add("等待处理载荷",MsgLevel.info);
break; break;
......
支持 Markdown 格式
你添加了 0 到此讨论。请谨慎行事。
Finish editing this message first!