fix: skærebords-skift bakker fri til 15 m plads foran før ruten drejer — 1.62.161

This commit is contained in:
2026-10-10 06:19:45 +02:00
parent 8f98532559
commit d6886ed85c
3 changed files with 54 additions and 2 deletions
+52 -1
View File
@@ -22,6 +22,13 @@ ADHeaderSwap.ATTACH_TIMEOUT_MS = 4000
ADHeaderSwap.FOLD_TIMEOUT_MS = 30000
ADHeaderSwap.FOLD_DONE_EPS = 0.01
ADHeaderSwap.LIFT_MS = 2000 -- skærebordet hæves, før det foldes til transport
-- Bak fri efter afkobling foran: til der er så meget fri plads mellem mejetærskerens front og skærebordet. AD's rute
-- starter ca. 7 m fremme og drejer, og skærebordet er ~12 m bredt (in-game 10/10: ADHitchCreep's bak-fri stoppede
-- efter 5,5 m, og mejetærskeren svingede ind i skærebordets ende — to gange).
ADHeaderSwap.BACKOFF_CLEAR_M = 15
ADHeaderSwap.BACKOFF_MAX_M = 30
ADHeaderSwap.BACKOFF_TIMEOUT_MS = 40000
ADHeaderSwap.BACKOFF_SPEED = 4 -- km/t
ADHeaderSwap.DETACH_RETRY_MS = 10000 -- afkobling forsøges igen så længe (spillet: "Detach while folding is not allowed")
-- ---- ren logik ----
@@ -67,6 +74,13 @@ function ADHeaderSwap.foldTarget(turnOnFoldDirection, toWork)
return direction, direction > 0 and 1 or 0
end
-- s = {gap = m fri foran fronten, moved = m bakket, elapsedMs} -> "done" | "drive" | "giveUp"
function ADHeaderSwap.backOffStep(s)
if (s.gap or 0) >= ADHeaderSwap.BACKOFF_CLEAR_M then return "done" end
if (s.moved or 0) >= ADHeaderSwap.BACKOFF_MAX_M or (s.elapsedMs or 0) >= ADHeaderSwap.BACKOFF_TIMEOUT_MS then return "giveUp" end
return "drive"
end
-- s = {animTime, target, elapsedMs, moving} -> "done" | "wait" | "timeout"
-- Færdig først når animationen også står stille (in-game 10/10: 99 % foldet -> "Detach while folding is not allowed").
function ADHeaderSwap.foldStep(s)
@@ -374,6 +388,43 @@ local function detachTask(swap)
return task
end
-- Bak lige tilbage, til skærebordet står BACKOFF_CLEAR_M foran mejetærskerens front (afstand langs mejetærskeren til
-- skærebordets nærmeste del regnes groft som afstand til roden minus halv skærebordsdybde).
local function backOffTask(swap)
local task = newTask(swap, "Bakker fri af skærebordet")
function task:setUp()
self.start = {getWorldTranslation(swap.combine.rootNode)}
Logging.info(ADHeaderSwap.LOG_PREFIX .. "'%s' bakker fri af '%s' (til %d m fri plads foran)", vehicleName(swap.combine), vehicleName(swap.header), ADHeaderSwap.BACKOFF_CLEAR_M)
end
function task:update(dt)
self.elapsedMs = self.elapsedMs + dt
local combine, autoDrive = swap.combine, swap.adEnv.AutoDrive
local x, _, z = getWorldTranslation(combine.rootNode)
local moved = math.sqrt((x - self.start[1]) ^ 2 + (z - self.start[3]) ^ 2)
local hx, hy, hz = getWorldTranslation(swap.header.rootNode)
local _, _, lz = worldToLocal(combine.rootNode, hx, hy, hz)
local combineHalf = (combine.size ~= nil and combine.size.length or 10) / 2
local headerHalf = (swap.header.size ~= nil and swap.header.size.length or 4) / 2
local gap = lz - combineHalf - headerHalf
local action = ADHeaderSwap.backOffStep({gap = gap, moved = moved, elapsedMs = self.elapsedMs})
if action ~= "drive" then
stopDriving(combine)
if action == "done" then
Logging.info(ADHeaderSwap.LOG_PREFIX .. "'%s' er fri af skærebordet efter %.1f m (%.1f m fri foran)", vehicleName(combine), moved, gap)
else
Logging.warning(ADHeaderSwap.LOG_PREFIX .. "'%s' kom kun %.1f m tilbage (%.1f m fri foran) — kører videre", vehicleName(combine), moved, gap)
end
return taskDone(swap)
end
local sdm = combine.ad.specialDrivingModule
if sdm ~= nil and sdm.releaseVehicle ~= nil then sdm:releaseVehicle() end
local bx, by, bz = localToWorld(combine.rootNode, 0, 0, -20)
local lx, lz2 = autoDrive.getDriveDirection(combine, bx, by, bz)
autoDrive.driveInDirection(combine, dt, 30, 0.3, 0.2, 20, true, false, -lx, -lz2, ADHeaderSwap.BACKOFF_SPEED, 1)
end
return task
end
local function doneTask(swap, text)
local task = newTask(swap, "Færdig")
function task:setUp() finish(swap, true, text) end
@@ -447,7 +498,7 @@ function ADHeaderSwap.mountRear(adEnv, combine, onDone)
if combineJoint(combine, trailerType, false) == nil then return false, "mejetærskeren har ingen trailer-krog bag" end
local swap = {adEnv = adEnv, combine = combine, header = header, onDone = onDone}
local ok, why = runTasks(adEnv, combine, {
foldTask(swap, false), detachTask(swap), ADHitchCreep.newBackOffTask(adEnv, combine, header), pathTask(swap, true),
foldTask(swap, false), detachTask(swap), backOffTask(swap), pathTask(swap, true),
approachTask(swap, false), attachTask(swap, false), doneTask(swap, "skærebordet hænger bag — klar til vejen"),
})
if not ok then return false, why end