lhiven
/
Rs.SkyLine
1
0
Fork 0
Code Issues Pull Requests Packages Projects Releases Wiki Activity

8个轴同时回原改为单个回原

Browse Source
master
lhiven 1 year ago
parent e6533555f6
commit de8a4053fb
1 changed files with 78 additions and 83 deletions
Show Stats Download Patch File Download Diff File

161
Rs.SkyLine/Flow/SubFlow/ZRHomeFlow.cs
Unescape Escape View File

@ -32,97 +32,92 @@ namespace Rs.MotionPlat.Flow.SubFlow
return instance; return instance;
} }
} }
private ManualResetEvent homeFinished = new ManualResetEvent(true);
private EZRHomeFlowStep step = EZRHomeFlowStep.StartHome; private EZRHomeFlowStep step = EZRHomeFlowStep.StartHome;
bool finished = true; bool finished = false;
public void GoHome() public void GoHome(int homeIndex)
{ {
finished = false;
step = EZRHomeFlowStep.StartHome; step = EZRHomeFlowStep.StartHome;
if (finished) while (!finished)
{ {
homeFinished.Reset(); switch (step)
finished = false;
}
else
return;
Task.Run(() => {
while (!finished)
{ {
switch (step) case EZRHomeFlowStep.StartHome:
{ //获取Z轴
case EZRHomeFlowStep.StartHome: AxisControl.GetAxis($"NozzleZ{homeIndex}").Home();
AxisControl.NozzleZ1.Home(); AxisControl.GetAxis($"NozzleR{homeIndex}").Home();
AxisControl.NozzleZ2.Home(); //AxisControl.NozzleZ1.Home();
AxisControl.NozzleZ3.Home(); //AxisControl.NozzleZ2.Home();
AxisControl.NozzleZ4.Home(); //AxisControl.NozzleZ3.Home();
AxisControl.NozzleZ5.Home(); //AxisControl.NozzleZ4.Home();
AxisControl.NozzleZ6.Home(); //AxisControl.NozzleZ5.Home();
AxisControl.NozzleZ7.Home(); //AxisControl.NozzleZ6.Home();
AxisControl.NozzleZ8.Home(); //AxisControl.NozzleZ7.Home();
//AxisControl.NozzleZ8.Home();
AxisControl.NozzleR1.Home(); //AxisControl.NozzleR1.Home();
AxisControl.NozzleR2.Home(); //AxisControl.NozzleR2.Home();
AxisControl.NozzleR3.Home(); //AxisControl.NozzleR3.Home();
AxisControl.NozzleR4.Home(); //AxisControl.NozzleR4.Home();
AxisControl.NozzleR5.Home(); //AxisControl.NozzleR5.Home();
AxisControl.NozzleR6.Home(); //AxisControl.NozzleR6.Home();
AxisControl.NozzleR7.Home(); //AxisControl.NozzleR7.Home();
AxisControl.NozzleR8.Home(); //AxisControl.NozzleR8.Home();
step = EZRHomeFlowStep.WaitHomed; step = EZRHomeFlowStep.WaitHomed;
break; Thread.Sleep(1000);
case EZRHomeFlowStep.WaitHomed: break;
if(AxisControl.NozzleZ1.HomeStatus== EHomeStatus.Finished case EZRHomeFlowStep.WaitHomed:
&& AxisControl.NozzleZ2.HomeStatus == EHomeStatus.Finished //if(AxisControl.NozzleZ1.HomeStatus== EHomeStatus.Finished
&& AxisControl.NozzleZ3.HomeStatus == EHomeStatus.Finished // && AxisControl.NozzleZ2.HomeStatus == EHomeStatus.Finished
&& AxisControl.NozzleZ4.HomeStatus == EHomeStatus.Finished // && AxisControl.NozzleZ3.HomeStatus == EHomeStatus.Finished
&& AxisControl.NozzleZ5.HomeStatus == EHomeStatus.Finished // && AxisControl.NozzleZ4.HomeStatus == EHomeStatus.Finished
&& AxisControl.NozzleZ6.HomeStatus == EHomeStatus.Finished // && AxisControl.NozzleZ5.HomeStatus == EHomeStatus.Finished
&& AxisControl.NozzleZ7.HomeStatus == EHomeStatus.Finished // && AxisControl.NozzleZ6.HomeStatus == EHomeStatus.Finished
&& AxisControl.NozzleZ8.HomeStatus == EHomeStatus.Finished // && AxisControl.NozzleZ7.HomeStatus == EHomeStatus.Finished
&& AxisControl.NozzleR1.HomeStatus == EHomeStatus.Finished // && AxisControl.NozzleZ8.HomeStatus == EHomeStatus.Finished
&& AxisControl.NozzleR2.HomeStatus == EHomeStatus.Finished // && AxisControl.NozzleR1.HomeStatus == EHomeStatus.Finished
&& AxisControl.NozzleR3.HomeStatus == EHomeStatus.Finished // && AxisControl.NozzleR2.HomeStatus == EHomeStatus.Finished
&& AxisControl.NozzleR4.HomeStatus == EHomeStatus.Finished // && AxisControl.NozzleR3.HomeStatus == EHomeStatus.Finished
&& AxisControl.NozzleR5.HomeStatus == EHomeStatus.Finished // && AxisControl.NozzleR4.HomeStatus == EHomeStatus.Finished
&& AxisControl.NozzleR6.HomeStatus == EHomeStatus.Finished // && AxisControl.NozzleR5.HomeStatus == EHomeStatus.Finished
&& AxisControl.NozzleR7.HomeStatus == EHomeStatus.Finished // && AxisControl.NozzleR6.HomeStatus == EHomeStatus.Finished
&& AxisControl.NozzleR8.HomeStatus == EHomeStatus.Finished) // && AxisControl.NozzleR7.HomeStatus == EHomeStatus.Finished
{ // && AxisControl.NozzleR8.HomeStatus == EHomeStatus.Finished)
step = EZRHomeFlowStep.GoStartPos; if (AxisControl.GetAxis($"NozzleZ{homeIndex}").HomeStatus == EHomeStatus.Finished
} && AxisControl.GetAxis($"NozzleR{homeIndex}").HomeStatus == EHomeStatus.Finished)
break; {
case EZRHomeFlowStep.GoStartPos: step = EZRHomeFlowStep.GoStartPos;
for(int i=1;i<9;i++) }
{ break;
double targetPos = SysConfigParam.GetValue<Double>($"NozzleR{i}StartPos"); case EZRHomeFlowStep.GoStartPos:
AxisControl.GetAxis($"NozzleR{i}").MovePos(targetPos, GlobalVar.WholeSpeed); //for(int i=1;i<9;i++)
} //{
step = EZRHomeFlowStep.WaitArrivedStartPos; // double targetPos = SysConfigParam.GetValue<Double>($"NozzleR{i}StartPos");
break; // AxisControl.GetAxis($"NozzleR{i}").MovePos(targetPos, GlobalVar.WholeSpeed);
case EZRHomeFlowStep.WaitArrivedStartPos: //}
if(Ops.IsStop("NozzleR1") double targetPos = SysConfigParam.GetValue<Double>($"NozzleR{homeIndex}StartPos");
&& Ops.IsStop("NozzleR2") AxisControl.GetAxis($"NozzleR{homeIndex}").MovePos(targetPos, GlobalVar.WholeSpeed);
&& Ops.IsStop("NozzleR3") step = EZRHomeFlowStep.WaitArrivedStartPos;
&& Ops.IsStop("NozzleR4") Thread.Sleep(100);
&& Ops.IsStop("NozzleR5") break;
&& Ops.IsStop("NozzleR6") case EZRHomeFlowStep.WaitArrivedStartPos:
&& Ops.IsStop("NozzleR7") //if(Ops.IsStop("NozzleR1")
&& Ops.IsStop("NozzleR8")) // && Ops.IsStop("NozzleR2")
{ // && Ops.IsStop("NozzleR3")
finished = true; // && Ops.IsStop("NozzleR4")
homeFinished.Set(); // && Ops.IsStop("NozzleR5")
} // && Ops.IsStop("NozzleR6")
break; // && Ops.IsStop("NozzleR7")
} // && Ops.IsStop("NozzleR8"))
if (Ops.IsStop($"NozzleR{homeIndex}"))
{
finished = true;
}
break;
} }
}); Thread.Sleep(10);
} }
public bool Wait()
{
return homeFinished.WaitOne();
} }
} }
} }

Write Preview
Loading…
Cancel
Save