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

按照秦工的需求，优化取料盘和放料盘逻辑

Browse Source
develop
lhiven 2 months ago
parent ae9eab279c
commit b9110b7ca2
2 changed files with 80 additions and 68 deletions
Show Stats Download Patch File Download Diff File

14
Rs.DeweyTester/Flow/NormalFlow/StockFlowBase.cs
Unescape Escape View File

@ -285,9 +285,9 @@ namespace Rs.MotionPlat.Flow.NormalFlow
public void Up() public void Up()
{ {
if(CurrentLayer==1) if(CurrentLayer==0)
{ {
logInfo = $"{GetClassName()} 料仓{StockIndex}已处于第一层，不能再上升"; logInfo = $"{GetClassName()} 料仓{StockIndex}已处于第{CurrentLayer}层，不能再上升";
MessageQueue.Instance.Warn(logInfo); MessageQueue.Instance.Warn(logInfo);
return; return;
} }
@ -311,11 +311,11 @@ namespace Rs.MotionPlat.Flow.NormalFlow
Thread.Sleep(500); Thread.Sleep(500);
logInfo = $"{GetClassName()} 料仓{StockIndex}已运动到{CurrentLayer}层，cz:{Ops.GetCurPosition($"StockZ{StockIndex}")}"; logInfo = $"{GetClassName()} 料仓{StockIndex}已运动到{CurrentLayer}层，cz:{Ops.GetCurPosition($"StockZ{StockIndex}")}";
MessageQueue.Instance.Insert(logInfo); MessageQueue.Instance.Insert(logInfo);
if (HasTray()) //if (HasTray())
{ //{
ClampTray(); // ClampTray();
Thread.Sleep(GlobalVar.StepMotorMoveDelayTime); // Thread.Sleep(GlobalVar.StepMotorMoveDelayTime);
} //}
break; break;
} }
else if (stopwatch.ElapsedMilliseconds > 5000) else if (stopwatch.ElapsedMilliseconds > 5000)

116
Rs.DeweyTester/Flow/NormalFlow/TakeTrayFlow.cs
Unescape Escape View File

@ -25,6 +25,7 @@ namespace Rs.MotionPlat.Flow
到取料盘上方, 到取料盘上方,
等待到取料盘上方, 等待到取料盘上方,
等待料盘准备就绪, 等待料盘准备就绪,
到下方取料位,
等待运动到取料位下方, 等待运动到取料位下方,
//等待夹磁气缸松开, //等待夹磁气缸松开,
取料盘完成抬起, 取料盘完成抬起,
@ -185,6 +186,8 @@ namespace Rs.MotionPlat.Flow
StockManager.CloseTray(fromStockIndex); StockManager.CloseTray(fromStockIndex);
} }
AxisPosPrint.PrintTakeTrayXCurrentPos($"已运动到料仓{m_fromTray}取料盘位上方", GetClassName()); AxisPosPrint.PrintTakeTrayXCurrentPos($"已运动到料仓{m_fromTray}取料盘位上方", GetClassName());
//松开夹爪
StockManager.OpenTray(fromStockIndex);
step = ETakeTrayFlowStep.等待料盘准备就绪; step = ETakeTrayFlowStep.等待料盘准备就绪;
} }
} }
@ -194,6 +197,7 @@ namespace Rs.MotionPlat.Flow
} }
break; break;
case ETakeTrayFlowStep.等待料盘准备就绪: case ETakeTrayFlowStep.等待料盘准备就绪:
try try
{ {
@ -201,9 +205,9 @@ namespace Rs.MotionPlat.Flow
{ {
logInfo = GetClassName() + $"料仓{m_fromTray}料盘准备就绪"; logInfo = GetClassName() + $"料仓{m_fromTray}料盘准备就绪";
MessageQueue.Instance.Insert(logInfo); MessageQueue.Instance.Insert(logInfo);
TakeTrayModule.CylinderGoDown(GetClassName());
stopwatch.Restart(); step = ETakeTrayFlowStep.上升一层;
step = ETakeTrayFlowStep.等待运动到取料位下方; //step = ETakeTrayFlowStep.等待运动到取料位下方;
} }
else else
{ {
@ -216,6 +220,26 @@ namespace Rs.MotionPlat.Flow
AlarmCollection.SystemExceptionAlarm(ex); AlarmCollection.SystemExceptionAlarm(ex);
} }
break;
case ETakeTrayFlowStep.上升一层:
try
{
StockManager.Up(fromStockIndex);
logInfo = GetClassName() + $"料仓{fromTray}上升一层";
MessageQueue.Instance.Insert(logInfo);
step = ETakeTrayFlowStep.到下方取料位;
}
catch (Exception ex)
{
AlarmCollection.SystemExceptionAlarm(ex);
}
break;
case ETakeTrayFlowStep.到下方取料位:
{
TakeTrayModule.CylinderGoDown(GetClassName());
stopwatch.Restart();
}
break; break;
case ETakeTrayFlowStep.等待运动到取料位下方: case ETakeTrayFlowStep.等待运动到取料位下方:
try try
@ -227,10 +251,8 @@ namespace Rs.MotionPlat.Flow
stopwatch.Stop(); stopwatch.Stop();
//打开真空 //打开真空
TakeTrayModule.VacOperation(EIoOperate.Open, GetClassName()); TakeTrayModule.VacOperation(EIoOperate.Open, GetClassName());
//松开夹爪 StockManager.CloseTray(fromStockIndex);
//StockModule.ClampTrayCylinder(EIoOperate.Open, fromStockIndex,GetClassName()); //stopwatch.Restart();
StockManager.OpenTray(fromStockIndex);
stopwatch.Restart();
step = ETakeTrayFlowStep.取料盘完成抬起; step = ETakeTrayFlowStep.取料盘完成抬起;
} }
else if (stopwatch.ElapsedMilliseconds > 5000) else if (stopwatch.ElapsedMilliseconds > 5000)
@ -245,7 +267,7 @@ namespace Rs.MotionPlat.Flow
{ {
Msg.ShowError("翻译文件中未找到料盘搬运气缸动位异常"); Msg.ShowError("翻译文件中未找到料盘搬运气缸动位异常");
} }
stopwatch.Restart(); //stopwatch.Restart();
} }
} }
catch (Exception ex) catch (Exception ex)
@ -255,6 +277,7 @@ namespace Rs.MotionPlat.Flow
break; break;
case ETakeTrayFlowStep.取料盘完成抬起: case ETakeTrayFlowStep.取料盘完成抬起:
{
try try
{ {
TakeTrayModule.CylinderGoUp(GetClassName()); TakeTrayModule.CylinderGoUp(GetClassName());
@ -265,7 +288,7 @@ namespace Rs.MotionPlat.Flow
{ {
AlarmCollection.SystemExceptionAlarm(ex); AlarmCollection.SystemExceptionAlarm(ex);
} }
}
break; break;
case ETakeTrayFlowStep.等待取料盘完成抬起: case ETakeTrayFlowStep.等待取料盘完成抬起:
try try
@ -305,22 +328,37 @@ namespace Rs.MotionPlat.Flow
{ {
logInfo = GetClassName() + $"料盘已被抓起 OK"; logInfo = GetClassName() + $"料盘已被抓起 OK";
MessageQueue.Instance.Insert(logInfo); MessageQueue.Instance.Insert(logInfo);
if (StockManager.GetCurrentLayer(fromStockIndex) == 1) if (fromTray == ETrayType.Input)
{ {
step = ETakeTrayFlowStep.到放料盘上方; step = ETakeTrayFlowStep.上料仓拍照处理;
} }
else else
{ {
step = ETakeTrayFlowStep.上升一层; if (placeTrayGrab && GlobalVar.EnableBeforePlaceTrayToOkGrab)
{
step = ETakeTrayFlowStep.放料盘前拍照;
}
else
{
step = ETakeTrayFlowStep.到放料盘上方;
} }
} }
//if (StockManager.GetCurrentLayer(fromStockIndex) == 1)
//{
// step = ETakeTrayFlowStep.到放料盘上方;
//}
//else
//{
// step = ETakeTrayFlowStep.上升一层;
//}
}
else else
{ {
alarmEntity = AlarmCollection.Get(AlarmConstID.料盘未抓起报警).Transform(fromTray.ToString()); alarmEntity = AlarmCollection.Get(AlarmConstID.料盘未抓起报警).Transform(fromTray.ToString());
if (alarmEntity != null) if (alarmEntity != null)
{ {
Msgbox.ShowDialog(alarmEntity, EButtonType.Retry, true); Msgbox.ShowDialog(alarmEntity, EButtonType.Retry, true);
step = ETakeTrayFlowStep.到取料盘上方; step = ETakeTrayFlowStep.到下方取料位;
} }
else else
{ {
@ -334,45 +372,18 @@ namespace Rs.MotionPlat.Flow
} }
break; break;
case ETakeTrayFlowStep.上升一层:
try
{
StockManager.Up(fromStockIndex);
logInfo = GetClassName() + $"料仓{fromTray}上升一层";
MessageQueue.Instance.Insert(logInfo);
step = ETakeTrayFlowStep.等待上升一层完成;
}
catch (Exception ex)
{
AlarmCollection.SystemExceptionAlarm(ex);
}
break; //case ETakeTrayFlowStep.等待上升一层完成:
case ETakeTrayFlowStep.等待上升一层完成: // try
try // {
{
if (fromTray == ETrayType.Input)
{
step = ETakeTrayFlowStep.上料仓拍照处理;
}
else
{
if (placeTrayGrab && GlobalVar.EnableBeforePlaceTrayToOkGrab)
{
step = ETakeTrayFlowStep.放料盘前拍照;
}
else
{
step = ETakeTrayFlowStep.到放料盘上方;
}
}
}
catch (Exception ex)
{
AlarmCollection.SystemExceptionAlarm(ex);
}
break; // }
// catch (Exception ex)
// {
// AlarmCollection.SystemExceptionAlarm(ex);
// }
// break;
case ETakeTrayFlowStep.上料仓拍照处理: case ETakeTrayFlowStep.上料仓拍照处理:
try try
{ {
@ -501,13 +512,14 @@ namespace Rs.MotionPlat.Flow
//logInfo = GetClassName() + $"料盘真空关 on"; //logInfo = GetClassName() + $"料盘真空关 on";
//MessageQueue.Instance.Insert(logInfo); //MessageQueue.Instance.Insert(logInfo);
//Thread.Sleep(100); //Thread.Sleep(100);
//关闭真空吸
TakeTrayModule.VacOperation(EIoOperate.Close, GetClassName());
if (isNeedGoDown) if (isNeedGoDown)
{ {
StockManager.Down(toStockIndex); StockManager.Down(toStockIndex);
} }
StockManager.CloseTray(toStockIndex); StockManager.CloseTray(toStockIndex);
//关闭真空吸
TakeTrayModule.VacOperation(EIoOperate.Close, GetClassName());
step = ETakeTrayFlowStep.放料盘完成后抬起; step = ETakeTrayFlowStep.放料盘完成后抬起;
} }
else if (stopwatch.ElapsedMilliseconds > 5000) else if (stopwatch.ElapsedMilliseconds > 5000)

Write Preview
Loading…
Cancel
Save