|
|
@ -43,6 +43,7 @@ namespace Rs.MotionPlat.Flow
|
|
|
|
homeStep = 0;
|
|
|
|
homeStep = 0;
|
|
|
|
m_bHomed = false;
|
|
|
|
m_bHomed = false;
|
|
|
|
m_bCancle = false;
|
|
|
|
m_bCancle = false;
|
|
|
|
|
|
|
|
double dist = 22.0;
|
|
|
|
Task.Run(() =>
|
|
|
|
Task.Run(() =>
|
|
|
|
{
|
|
|
|
{
|
|
|
|
while (!m_bCancle && !m_bHomed)
|
|
|
|
while (!m_bCancle && !m_bHomed)
|
|
|
@ -84,45 +85,90 @@ namespace Rs.MotionPlat.Flow
|
|
|
|
{
|
|
|
|
{
|
|
|
|
AxisControl.GetAxis($"NozzleZ1").Home();
|
|
|
|
AxisControl.GetAxis($"NozzleZ1").Home();
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
else
|
|
|
|
|
|
|
|
{
|
|
|
|
|
|
|
|
AxisControl.GetAxis($"NozzleZ1").HomeStatus = Motion.EHomeStatus.Finished;
|
|
|
|
|
|
|
|
AxisControl.GetAxis($"NozzleZ1").MoveOffset(dist, 5);
|
|
|
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
if (NozzleManager.GetNozzle(2).Enable)
|
|
|
|
if (NozzleManager.GetNozzle(2).Enable)
|
|
|
|
{
|
|
|
|
{
|
|
|
|
AxisControl.GetAxis($"NozzleZ2").Home();
|
|
|
|
AxisControl.GetAxis($"NozzleZ2").Home();
|
|
|
|
|
|
|
|
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
else
|
|
|
|
|
|
|
|
{
|
|
|
|
|
|
|
|
AxisControl.GetAxis($"NozzleZ2").HomeStatus = Motion.EHomeStatus.Finished;
|
|
|
|
|
|
|
|
AxisControl.GetAxis($"NozzleZ2").MoveOffset(dist, 5);
|
|
|
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
if (NozzleManager.GetNozzle(3).Enable)
|
|
|
|
if (NozzleManager.GetNozzle(3).Enable)
|
|
|
|
{
|
|
|
|
{
|
|
|
|
AxisControl.GetAxis($"NozzleZ3").Home();
|
|
|
|
AxisControl.GetAxis($"NozzleZ3").Home();
|
|
|
|
|
|
|
|
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
else
|
|
|
|
|
|
|
|
{
|
|
|
|
|
|
|
|
AxisControl.GetAxis($"NozzleZ3").HomeStatus = Motion.EHomeStatus.Finished;
|
|
|
|
|
|
|
|
AxisControl.GetAxis($"NozzleZ3").MoveOffset(dist, 5);
|
|
|
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
if (NozzleManager.GetNozzle(4).Enable)
|
|
|
|
if (NozzleManager.GetNozzle(4).Enable)
|
|
|
|
{
|
|
|
|
{
|
|
|
|
AxisControl.GetAxis($"NozzleZ4").Home();
|
|
|
|
AxisControl.GetAxis($"NozzleZ4").Home();
|
|
|
|
|
|
|
|
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
else
|
|
|
|
|
|
|
|
{
|
|
|
|
|
|
|
|
AxisControl.GetAxis($"NozzleZ4").HomeStatus = Motion.EHomeStatus.Finished;
|
|
|
|
|
|
|
|
AxisControl.GetAxis($"NozzleZ4").MoveOffset(dist, 5);
|
|
|
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
if (NozzleManager.GetNozzle(5).Enable)
|
|
|
|
if (NozzleManager.GetNozzle(5).Enable)
|
|
|
|
{
|
|
|
|
{
|
|
|
|
AxisControl.GetAxis($"NozzleZ5").Home();
|
|
|
|
AxisControl.GetAxis($"NozzleZ5").Home();
|
|
|
|
|
|
|
|
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
else
|
|
|
|
|
|
|
|
{
|
|
|
|
|
|
|
|
AxisControl.GetAxis($"NozzleZ5").HomeStatus = Motion.EHomeStatus.Finished;
|
|
|
|
|
|
|
|
AxisControl.GetAxis($"NozzleZ5").MoveOffset(dist, 5);
|
|
|
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
if (NozzleManager.GetNozzle(6).Enable)
|
|
|
|
if (NozzleManager.GetNozzle(6).Enable)
|
|
|
|
{
|
|
|
|
{
|
|
|
|
AxisControl.GetAxis($"NozzleZ6").Home();
|
|
|
|
AxisControl.GetAxis($"NozzleZ6").Home();
|
|
|
|
|
|
|
|
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
else
|
|
|
|
|
|
|
|
{
|
|
|
|
|
|
|
|
AxisControl.GetAxis($"NozzleZ6").HomeStatus = Motion.EHomeStatus.Finished;
|
|
|
|
|
|
|
|
AxisControl.GetAxis($"NozzleZ6").MoveOffset(dist, 5);
|
|
|
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
if (NozzleManager.GetNozzle(7).Enable)
|
|
|
|
if (NozzleManager.GetNozzle(7).Enable)
|
|
|
|
{
|
|
|
|
{
|
|
|
|
AxisControl.GetAxis($"NozzleZ7").Home();
|
|
|
|
AxisControl.GetAxis($"NozzleZ7").Home();
|
|
|
|
|
|
|
|
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
else
|
|
|
|
|
|
|
|
{
|
|
|
|
|
|
|
|
AxisControl.GetAxis($"NozzleZ7").HomeStatus = Motion.EHomeStatus.Finished;
|
|
|
|
|
|
|
|
AxisControl.GetAxis($"NozzleZ7").MoveOffset(dist, 5);
|
|
|
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
if (NozzleManager.GetNozzle(8).Enable)
|
|
|
|
if (NozzleManager.GetNozzle(8).Enable)
|
|
|
|
{
|
|
|
|
{
|
|
|
|
AxisControl.GetAxis($"NozzleZ8").Home();
|
|
|
|
AxisControl.GetAxis($"NozzleZ8").Home();
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
else
|
|
|
|
|
|
|
|
{
|
|
|
|
|
|
|
|
AxisControl.GetAxis($"NozzleZ8").HomeStatus = Motion.EHomeStatus.Finished;
|
|
|
|
|
|
|
|
AxisControl.GetAxis($"NozzleZ8").MoveOffset(dist, 5);
|
|
|
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
//AxisControl.GetAxis($"NozzleZ9").Home();
|
|
|
|
//AxisControl.GetAxis($"NozzleZ9").Home();
|
|
|
|
//保压Z轴回原
|
|
|
|
//保压Z轴回原
|
|
|
|
AxisControl.PressZ.Home();
|
|
|
|
AxisControl.PressZ.Home();
|
|
|
@ -134,7 +180,7 @@ namespace Rs.MotionPlat.Flow
|
|
|
|
case 1://等待所有Z轴回原完成
|
|
|
|
case 1://等待所有Z轴回原完成
|
|
|
|
if (homeTime.ElapsedMilliseconds < 1000 * 60 * 2)//5分钟还未回零成功,则返回回零超时
|
|
|
|
if (homeTime.ElapsedMilliseconds < 1000 * 60 * 2)//5分钟还未回零成功,则返回回零超时
|
|
|
|
{
|
|
|
|
{
|
|
|
|
if (Ops.AllZHomed() && Ops.IsHomed("StockZ1", "StockZ2", "StockZ3", "StockZ4", "StockZ5", "StockZ6", "PressZ", "TurnoverZ"))
|
|
|
|
if (Ops.AllZStoped() && Ops.AllZHomed() && Ops.IsHomed("StockZ1", "StockZ2", "StockZ3", "StockZ4", "StockZ5", "StockZ6", "PressZ", "TurnoverZ"))
|
|
|
|
{
|
|
|
|
{
|
|
|
|
MessageQueue.Instance.Insert("Z axis home finished!");
|
|
|
|
MessageQueue.Instance.Insert("Z axis home finished!");
|
|
|
|
homeStep++;
|
|
|
|
homeStep++;
|
|
|
|