fix: skærebord aldrig løst på marken, CP genstartes efter off track, tømmevogne venter inde på marken (1.62.196-199)

- tømmevognenes CP-venteplads 20 m inde på marken og 40 m til siden, ikke på F-markøren
- Courseplay stoppet midt i kurset (husket waypoint findes) startes igen fra sidste punkt, højst 3 gange
- skærebord bag på: skift på den frie plads fra monteringen; slår det fejl, sættes det på foran igen;
  kør 20 m fri før ny rute ved skæv indkørsel
- koblingsture regner ankomstafstand ud fra hele sættets længde
This commit is contained in:
2026-10-10 12:47:36 +02:00
parent 7506a4e1e6
commit 59923c1bfa
9 changed files with 219 additions and 13 deletions
+86 -6
View File
@@ -31,6 +31,9 @@ ADHeaderSwap.BACKOFF_TIMEOUT_MS = 40000
ADHeaderSwap.BACKOFF_SPEED = 4 -- km/t
ADHeaderSwap.DETACH_RETRY_MS = 10000
ADHeaderSwap.PARKED_MAX_M = 25 -- et skærebord er kun "parkeret", når det står så tæt på sin P-markør
ADHeaderSwap.MOVE_AWAY_M = 20 -- før en ny rute: så langt væk fra skærebordet (ellers er AD's rute "kørt" med det samme)
ADHeaderSwap.MOVE_AWAY_TIMEOUT_MS = 30000
ADHeaderSwap.MOVE_AWAY_SPEED = 6 -- km/t
ADHeaderSwap.APPROACH_RETRIES = 2 -- står den for skævt efter ruten: ny rute så mange gange (in-game 10/10: 3,4 m ved siden af) -- afkobling forsøges igen så længe (spillet: "Detach while folding is not allowed")
-- ---- ren logik ----
@@ -104,6 +107,15 @@ function ADHeaderSwap.pickHeader(options, fruit, x, z)
return best
end
-- Skiftet bag på slog fejl: hvad skal der til for at få skærebordet sikkert på foran igen (aldrig efterladt løst på
-- marken, in-game 10/10 F14 to gange)? attached = skiftets skærebord sidder på, isFront = foran.
-- -> "fold" (sidder foran, fold til arbejde) | "remount" (løst: kør frem og kobl på foran) | nil (sidder bag: intet)
function ADHeaderSwap.recoveryPlan(attached, isFront)
if attached and isFront then return "fold" end
if not attached then return "remount" end
return nil
end
-- ---- spil ----
local active = {}
@@ -209,7 +221,10 @@ local function stopDriving(combine)
if sdm ~= nil and sdm.stopVehicle ~= nil then sdm:stopVehicle() end
end
local startRecovery
local function finish(swap, ok, text)
if not ok and swap.kind == "rear" and not swap.recovering and startRecovery ~= nil and startRecovery(swap, text) then return end
active[swap.combine] = nil
if ok then
Logging.info(ADHeaderSwap.LOG_PREFIX .. "'%s': %s", vehicleName(swap.combine), text)
@@ -306,6 +321,7 @@ local function pathTask(swap, reverse)
end
local approachTask
local moveAwayTask
-- Læg opgaver forrest i AD's kø (efter den aktive).
local function enqueueFirst(swap, tasks)
@@ -361,6 +377,35 @@ local function driveToSpotTask(swap, spot)
return task
end
-- Kør lige frem (forward) eller bak lige tilbage MOVE_AWAY_M, så der er plads til en ny indkørsel.
moveAwayTask = function(swap, forward)
local task = newTask(swap, "Kører fri af skærebordet")
function task:setUp()
self.start = {getWorldTranslation(swap.combine.rootNode)}
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)
if moved >= ADHeaderSwap.MOVE_AWAY_M or self.elapsedMs >= ADHeaderSwap.MOVE_AWAY_TIMEOUT_MS then
stopDriving(combine)
Logging.info(ADHeaderSwap.LOG_PREFIX .. "'%s' kørte %.1f m %s", vehicleName(combine), moved, forward and "frem" or "tilbage")
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, forward and 20 or -20)
local lx, lz = autoDrive.getDriveDirection(combine, bx, by, bz)
if forward then
autoDrive.driveInDirection(combine, dt, 30, 0.3, 0.2, 20, true, true, lx, lz, ADHeaderSwap.MOVE_AWAY_SPEED, 1)
else
autoDrive.driveInDirection(combine, dt, 30, 0.3, 0.2, 20, true, false, -lx, -lz, ADHeaderSwap.MOVE_AWAY_SPEED, 1)
end
end
return task
end
-- Det sidste stykke: ADHitchCreep's krybning (frem til frontkrogen / bak til bagkrogen).
approachTask = function(swap, front)
local task = newTask(swap, front and "Kører frem til skærebordet" or "Bakker til trækstangen")
@@ -375,9 +420,11 @@ approachTask = function(swap, front)
math.abs(target.offset.z), target.offset.z >= 0 and "foran" or "bag", target.offset.x)
if (swap.approachRetries or 0) < ADHeaderSwap.APPROACH_RETRIES then
swap.approachRetries = (swap.approachRetries or 0) + 1
Logging.info(ADHeaderSwap.LOG_PREFIX .. "'%s' %s — ny rute (%d/%d)", vehicleName(swap.combine), text,
Logging.info(ADHeaderSwap.LOG_PREFIX .. "'%s' %s — kører fri og prøver en ny rute (%d/%d)", vehicleName(swap.combine), text,
swap.approachRetries, ADHeaderSwap.APPROACH_RETRIES)
enqueueFirst(swap, {pathTask(swap, not front), approachTask(swap, front)})
-- først væk fra skærebordet: rutens mål lå kun 5 m væk, AD meldte den kørt med det samme, og begge
-- forsøg brugte 40 ms uden at mejetærskeren flyttede sig (in-game 10/10)
enqueueFirst(swap, {moveAwayTask(swap, not front), pathTask(swap, not front), approachTask(swap, front)})
return taskDone(swap)
end
return finish(swap, false, text)
@@ -520,6 +567,35 @@ local function doneTask(swap, text)
return task
end
-- Skiftet bag på slog fejl: skærebordet på foran igen og foldet ud, så mejetærskeren står som før skiftet. Spilleren
-- bedes derefter sætte det bag på (onDone med ok = false). -> true når redningen er startet.
startRecovery = function(swap, text)
local header, _, isFront = attachedHeader(swap.combine)
local plan = ADHeaderSwap.recoveryPlan(header == swap.header, isFront == true)
if plan == nil or (header ~= nil and header ~= swap.header) then return false end
local taskModule = swap.combine.ad ~= nil and swap.combine.ad.taskModule or nil
local stateModule = swap.combine.ad ~= nil and swap.combine.ad.stateModule or nil
if taskModule == nil or stateModule == nil or not stateModule:isActive() then return false end
swap.recovering, swap.approachRetries = true, 0
local failText = text .. " — skærebordet er sat på foran igen"
local tasks = {}
if plan == "remount" then
-- mejetærskeren står typisk med bagenden mod trækstangen: først rundt med stifinderen, så fronten vender
-- mod skærebordet (en kør-fri-bakning ville gå lige ind i det)
tasks = {pathTask(swap, false), approachTask(swap, true), attachTask(swap, true)}
end
table.insert(tasks, foldTask(swap, true))
local last = newTask(swap, "Færdig")
function last:setUp() finish(swap, false, failText) end
function last:update() end
table.insert(tasks, last)
Logging.warning(ADHeaderSwap.LOG_PREFIX .. "'%s': %s — sætter skærebordet på foran igen", vehicleName(swap.combine), text)
pcall(taskModule.abortAllTasks, taskModule)
stopDriving(swap.combine)
for _, task in ipairs(tasks) do taskModule:addTask(task) end
return true
end
-- ---- start ----
local function nearestMarkerId(adEnv, combine)
@@ -598,7 +674,7 @@ end
-- Sæt skærebordet bag på til vejen (efter høst). onDone(combine, ok, tekst).
-- Står skærebordet frakoblet i nærheden (fx efter et opgivet skift, in-game 10/10), køres der rundt og bakkes ind.
function ADHeaderSwap.mountRear(adEnv, combine, onDone)
function ADHeaderSwap.mountRear(adEnv, combine, onDone, opts)
if liveSwap(combine) ~= nil then return false, "skifter allerede skærebord" end
local header, _, isFront = attachedHeader(combine)
if header == nil then
@@ -619,11 +695,15 @@ function ADHeaderSwap.mountRear(adEnv, combine, onDone)
if not isFront then return false, "skærebordet sidder allerede bag" end
local _, trailerType = jointTypes()
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, {
local swap = {adEnv = adEnv, combine = combine, header = header, onDone = onDone, kind = "rear"}
local tasks = {
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"),
})
}
-- markarbejdet: skift på den frie plads, hvor skærebordet blev sat på foran (ikke midt i stubben eller ved en
-- kant, hvor stifinderen ingen vej finder — in-game 10/10 F14). Foldet til transport først: smallere at køre med.
if opts ~= nil and opts.spot ~= nil then table.insert(tasks, 2, driveToSpotTask(swap, opts.spot)) end
local ok, why = runTasks(adEnv, combine, tasks)
if not ok then return false, why end
active[combine] = swap
Logging.info(ADHeaderSwap.LOG_PREFIX .. "'%s' folder '%s' til transport og sætter det bag på", vehicleName(combine), vehicleName(header))