|
|
@ -528,14 +528,21 @@ namespace Rs.MotionPlat.Flow
|
|
|
|
//-----------------------------------------------测试位下料
|
|
|
|
//-----------------------------------------------测试位下料
|
|
|
|
case ETurnoverFlowStep.测试完成抬起到高速位:
|
|
|
|
case ETurnoverFlowStep.测试完成抬起到高速位:
|
|
|
|
targetPos = SysConfigParam.GetValue<double>("PressZ")+GlobalVar.PressLowSpeedOffset;
|
|
|
|
targetPos = SysConfigParam.GetValue<double>("PressZ")+GlobalVar.PressLowSpeedOffset;
|
|
|
|
|
|
|
|
double curPos = Ops.GetCurPosition(AxisAlias.PressZ);
|
|
|
|
errCode = AxisControl.PressZ.MovePos(targetPos, GlobalVar.PressLowSpeed);
|
|
|
|
if(curPos>targetPos)
|
|
|
|
if (errCode == Motion.ErrorCode.Ok)
|
|
|
|
|
|
|
|
{
|
|
|
|
{
|
|
|
|
logInfo = "测试完成准备抬起";
|
|
|
|
Step = ETurnoverFlowStep.测试完成抬起安全位;
|
|
|
|
MessageQueue.Instance.Insert(logInfo);
|
|
|
|
}
|
|
|
|
LogHelper.Debug(logInfo);
|
|
|
|
else
|
|
|
|
Step = ETurnoverFlowStep.等待测试完成抬起到高速位;
|
|
|
|
{
|
|
|
|
|
|
|
|
errCode = AxisControl.PressZ.MovePos(targetPos, GlobalVar.PressLowSpeed);
|
|
|
|
|
|
|
|
if (errCode == Motion.ErrorCode.Ok)
|
|
|
|
|
|
|
|
{
|
|
|
|
|
|
|
|
logInfo = "测试完成准备抬起";
|
|
|
|
|
|
|
|
MessageQueue.Instance.Insert(logInfo);
|
|
|
|
|
|
|
|
LogHelper.Debug(logInfo);
|
|
|
|
|
|
|
|
Step = ETurnoverFlowStep.等待测试完成抬起到高速位;
|
|
|
|
|
|
|
|
}
|
|
|
|
}
|
|
|
|
}
|
|
|
|
break;
|
|
|
|
break;
|
|
|
|
case ETurnoverFlowStep.等待测试完成抬起到高速位:
|
|
|
|
case ETurnoverFlowStep.等待测试完成抬起到高速位:
|
|
|
|