작업시작전에. 현재 위치를 확인하고 진행하게 함.

This commit is contained in:
backuppc
2026-02-09 13:59:19 +09:00
parent 7409528fbd
commit c2cc5d67ae
4 changed files with 30 additions and 3 deletions

View File

@@ -36,6 +36,19 @@ namespace Project
return false;
}
else if (PUB.sm.RunStepSeq == idx++)
{
//장비 노드 여부 확인 (버퍼가 아닌 도킹 가능 노드여야 함)
if (PUB._virtualAGV.CurrentNode.StationType != StationType.Loader &&
PUB._virtualAGV.CurrentNode.StationType != StationType.Clearner &&
PUB._virtualAGV.CurrentNode.StationType != StationType.UnLoader)
{
SetRunStepError(ENIGProtocol.AGVErrorCode.NOT_EQUIPMENTPOINT, $"[{funcname}-{PUB.sm.RunStepSeq}] 현재 위치가 장비 노드가 아닙니다({PUB._virtualAGV.CurrentNode.StationType})");
return false;
}
PUB.sm.UpdateRunStepSeq();
return false;
}
else if (PUB.sm.RunStepSeq == idx++)
{
//마크센서가 감지된상태여야 완전한위치로 가정한다
if (PUB.AGV.signal1.mark_sensor == false)
@@ -126,7 +139,7 @@ namespace Project
{
if (seqTime.TotalSeconds > 5)
{
if(VAR.I32[eVarInt32.RetryManget] < 3)
if (VAR.I32[eVarInt32.RetryManget] < 3)
{
PUB.sm.UpdateRunStepSeq(-1);
}
@@ -136,7 +149,7 @@ namespace Project
SetRunStepError(ENIGProtocol.AGVErrorCode.MAGNET_ON_ERROR, errmsg);
VAR.I32[eVarInt32.RetryManget] = 0;
}
}
return false;
}