Fix oscillation in AGV movement, add command cooldown, and enhance debug logs

This commit is contained in:
backuppc
2026-01-29 14:51:57 +09:00
parent 1da1f2de28
commit e99edbe04d
3 changed files with 68 additions and 26 deletions

View File

@@ -51,6 +51,7 @@ namespace Project
PUB.sm.SetNewRunStep(ERunStep.READY);
return false;
}
PUB.log.Add($"[GOTO] Step {idx-1}: TargetNode Checked ({PUB._virtualAGV.TargetNode.ID2})");
PUB.sm.UpdateRunStepSeq();
return false;
}
@@ -59,6 +60,7 @@ namespace Project
//모션 전후진 제어
if (UpdateMotionPositionForMark(funcName))
{
PUB.log.Add($"[GOTO] Step {idx-1}: UpdateMotionPositionForMark Completed. Stopping AGV.");
PUB.AGV.AGVMoveStop(funcName);
PUB.sm.UpdateRunStepSeq();
}
@@ -67,6 +69,7 @@ namespace Project
else if (PUB.sm.RunStepSeq == idx++)
{
//QC까지 모두 완료되었다.(완전히 정차할때까지 기다린다)
PUB.log.Add($"[GOTO] Step {idx-1}: Movement Finished. Waiting for full stop.");
PUB.Speak(Lang., true);
PUB.AddEEDB($"이동완료({PUB._virtualAGV.TargetNode.ID2})");
PUB.sm.UpdateRunStepSeq();