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
+46
View File
@@ -109,6 +109,52 @@ function ADFieldJobs.swapSpot(verts, x, z, cx, cz, inset)
return {x = bestX + vx / len * step, z = bestZ + vz / len * step, dirX = vx / len, dirZ = vz / len}
end
-- Tømmevognenes ventepladser: inset meter ind på marken fra kanten nærmest markøren, flyttet side meter langs kanten.
-- Courseplay-tømmevognen venter på sin startPosition; lå den på F-markøren, holdt tomme vogne i indkørslen og spærrede
-- for den næste mejetærsker (in-game 10/10 F14 med 3 maskiner). Sidelæns, så de heller ikke står på mejetærskernes
-- vej ind til skærebords-skiftet (swapSpot ligger på linjen lige ind fra kanten). -> {x, z} eller nil uden omrids.
function ADFieldJobs.waitSpot(verts, x, z, cx, cz, inset, side)
if verts == nil or #verts < 3 or cx == nil then return nil end
local best, bestD = nil, math.huge
for index = 1, #verts do
local a, b = verts[index], verts[index % #verts + 1]
local dx, dz = b.x - a.x, b.z - a.z
local len2 = dx * dx + dz * dz
local t = len2 > 0 and math.max(0, math.min(1, ((x - a.x) * dx + (z - a.z) * dz) / len2)) or 0
local d = (a.x + t * dx - x) ^ 2 + (a.z + t * dz - z) ^ 2
if d < bestD then best, bestD = {a = a, dx = dx, dz = dz, len2 = len2, t = t}, d end
end
if best == nil or best.len2 <= 0 then return nil end
local len = math.sqrt(best.len2)
-- langs kanten, men ikke ud over dens hjørner
local t = math.max(0, math.min(1, best.t + (side or 0) / len))
local ex, ez = best.a.x + t * best.dx, best.a.z + t * best.dz
local vx, vz = cx - ex, cz - ez
local vlen = math.sqrt(vx * vx + vz * vz)
if vlen < 1e-6 then return {x = ex, z = ez} end
local step = math.min(inset or 20, vlen)
local spot = {x = ex + vx / vlen * step, z = ez + vz / vlen * step}
-- skæv/L-formet mark: forskydningen kan ende uden for marken -> uden sideforskydning
if ADFieldJobs.insidePolygon ~= nil and not ADFieldJobs.insidePolygon(spot.x, spot.z, verts) and (side or 0) ~= 0 then
return ADFieldJobs.waitSpot(verts, x, z, cx, cz, inset, 0)
end
return spot
end
-- Courseplay stoppede, men kurset er ikke kørt færdigt (CP sletter sit huskede waypoint, når kurset er kørt helt
-- igennem): start det igen fra sidste punkt i stedet for at melde maskinen færdig (in-game 10/10 F14: "vehicle off
-- track, shutting off Courseplay now" -> mejetærskeren pakkede sammen og kørte hjem midt i marken).
-- Kun markarbejde der ikke selv stopper, når det er fuldt: opsamlere (fulde -> "is full") og tømmevogne ikke.
-- s = {rememberedIx, hasCourse, restarts, intended, controlled, helper, refillEmpty, collector, loaded}
ADFieldJobs.CP_RESTARTS = 3
ADFieldJobs.CP_RESTART_GRACE_MS = 20000 -- så længe må CP være om at komme i gang efter genstart
ADFieldJobs.CP_RESTART_RESET_MS = 300000 -- har den kørt så længe efter en genstart, tælles forfra
function ADFieldJobs.shouldRestartCp(s)
if s.intended or s.controlled or s.helper or s.refillEmpty or s.collector or s.loaded then return false end
if not s.hasCourse or type(s.rememberedIx) ~= "number" or s.rememberedIx <= 1 then return false end
return (s.restarts or 0) < ADFieldJobs.CP_RESTARTS
end
-- Kursets startpunkt inde på marken: står maskinen uden for marken (fx ved F-markøren ude ved vejen), lægger Courseplay
-- ellers kursets start uden for marken og kører ad vejen (in-game 10/10 F14). -> punktet på markkanten nærmest (x, z),
-- flyttet inset meter ind mod (cx, cz). Står maskinen allerede på marken: (x, z).
+51 -2
View File
@@ -8,6 +8,8 @@ ADFieldWork = {}
ADFieldWork.ARRIVE_DISTANCE = 30
ADFieldWork.IDLE_CONFIRM_MS = 5000
ADFieldWork.UNLOADER_WAIT_INSET_M = 20 -- tømmevognenes venteplads: så langt ind på marken fra kanten ved markøren
ADFieldWork.UNLOADER_WAIT_SIDE_M = 40 -- og så langt til siden langs kanten (væk fra mejetærskernes vej ind)
ADFieldWork.START_TIMEOUT_MS = 60000
ADFieldWork.COURSE_WAIT_MS = 180000
ADFieldWork.PLAYER_DRIVING_KMH = 3
@@ -1122,8 +1124,11 @@ local function beginUnloader(adEnv, field, info, assignment)
local point = ADFieldJobs.nearestPoint(info.points, vx, vz) or {x = info.x, z = info.z}
assignment.phase = "starting"
assignment.since = now()
local handle, err = ADCpBridge.startUnloader(vehicle, point.x, point.z, markerPoint ~= nil and markerPoint.x or point.x,
markerPoint ~= nil and markerPoint.z or point.z, station, function(ok, reason)
-- ventepladsen inde på marken, ikke på F-markøren (ADFieldJobs.waitSpot)
local waitX, waitZ = markerPoint ~= nil and markerPoint.x or point.x, markerPoint ~= nil and markerPoint.z or point.z
local wait = ADFieldJobs.waitSpot(info.verts, waitX, waitZ, info.x, info.z, ADFieldWork.UNLOADER_WAIT_INSET_M, ADFieldWork.UNLOADER_WAIT_SIDE_M)
if wait ~= nil then waitX, waitZ = wait.x, wait.z end
local handle, err = ADCpBridge.startUnloader(vehicle, point.x, point.z, waitX, waitZ, station, function(ok, reason)
if ok then
assignment.phase = "working"
assignment.since = now()
@@ -1464,6 +1469,32 @@ local function collectorStillMs(adEnv, assignment, vehicle)
return now() - assignment.stallSince
end
-- Courseplay stoppede midt i kurset (fx "off track"): start igen fra sidste punkt (ADFieldJobs.shouldRestartCp).
-- -> true når den blev startet igen (så er opgaven ikke færdig).
local function restartUnfinishedCp(adEnv, assignment)
local vehicle = assignment.vehicle
local okIx, rememberedIx = pcall(function()
return vehicle.getCpLastRememberedWaypointIx ~= nil and vehicle:getCpLastRememberedWaypointIx() or nil
end)
local refillEmpty = assignment.refillFillType ~= nil and ADCpBridge.getRefillLevel(vehicle, assignment.refillFillType) <= 0
local restart = ADFieldJobs.shouldRestartCp({
rememberedIx = okIx and rememberedIx or nil,
hasCourse = vehicle.hasCpCourse ~= nil and vehicle:hasCpCourse() == true,
restarts = assignment.cpRestarts, intended = assignment.cpStopIntended, controlled = isControlledByPlayer(vehicle),
helper = assignment.helper == true, refillEmpty = refillEmpty,
collector = assignment.role == "collector" or assignment.role == "baleCollector",
loaded = assignment.role ~= "harvester" and (restLoad(adEnv, vehicle) or 0) > 0,
})
if not restart then return false end
local okStart, started = pcall(ADCpResume.startAtLast, vehicle)
if not okStart or not started then return false end
assignment.cpRestarts = (assignment.cpRestarts or 0) + 1
assignment.idleSince, assignment.cpRestarting, assignment.cpRestartedAt = nil, now(), now()
log(assignment.fieldId, "'%s': Courseplay stoppede midt i kurset (waypoint %d) — startes igen fra sidste punkt (%d/%d)",
ADRuns.vehicleLabel(vehicle), rememberedIx, assignment.cpRestarts, ADFieldJobs.CP_RESTARTS)
return true
end
local function followWorking(adEnv, field, assignment)
local vehicle = assignment.vehicle
if assignment.role == "rake" and field.windrowOffset == nil and now() - assignment.since >= ADFieldWork.WINDROW_MEASURE_MS
@@ -1475,11 +1506,16 @@ local function followWorking(adEnv, field, assignment)
if ADCpBridge.isWorking(vehicle) or isAdActive(vehicle) then
assignment.idleSince = nil
assignment.seenWorking = true
assignment.cpRestarting = nil
if assignment.cpRestartedAt ~= nil and now() - assignment.cpRestartedAt >= ADFieldJobs.CP_RESTART_RESET_MS then
assignment.cpRestarts, assignment.cpRestartedAt = 0, nil
end
if assignment.role == "collector" and ADCpBridge.isWorking(vehicle) then
local okStill, stillMs = pcall(collectorStillMs, adEnv, assignment, vehicle)
if okStill and ADFieldJobs.collectorStalled({role = assignment.role, stillMs = stillMs}) then
-- intet at samle op: stop CP; næste tik afslutter som færdig (rest til lager, marken videre)
assignment.stallSince = nil
assignment.cpStopIntended = true
pcall(ADCpBridge.stop, vehicle)
local text = string.format("'%s' stod stille i %d min uden at samle noget op — opsamlingen stoppes",
ADRuns.vehicleLabel(vehicle), math.floor(ADFieldJobs.COLLECTOR_STALL_MS / 60000))
@@ -1497,8 +1533,16 @@ local function followWorking(adEnv, field, assignment)
end
return
end
-- genstartet (restartUnfinishedCp): giv CP tid til at komme i gang; kom den ikke, afsluttes opgaven som før
if assignment.cpRestarting ~= nil then
if now() - assignment.cpRestarting < ADFieldJobs.CP_RESTART_GRACE_MS then return end
assignment.cpRestarting = nil
assignment.cpRestarts = ADFieldJobs.CP_RESTARTS
log(assignment.fieldId, "'%s': Courseplay kom ikke i gang igen — opgaven afsluttes", ADRuns.vehicleLabel(vehicle))
end
assignment.idleSince = assignment.idleSince or now()
if now() - assignment.idleSince < ADFieldWork.IDLE_CONFIRM_MS then return end
if restartUnfinishedCp(adEnv, assignment) then return end
local rest = assignment.storeId ~= nil and not assignment.deliveredRest and restLoad(adEnv, vehicle) or 0
if rest > 0 and assignment.role == "harvester" and vehicle.spec_combine ~= nil then
-- mejetærsker: ikke selv til siloen med resten — røret skal foldes ud og ramme triggeren (og et skærebord på
@@ -1785,7 +1829,11 @@ function ADFieldWork.startHeaderSwap(adEnv, assignment, toward)
local vx, vz = vehiclePosition(assignment.vehicle)
local target = ADFieldJobs.coursePoint(info.points, vx, vz, info.fruitIndex) or {x = info.x, z = info.z}
mountOpts = {spot = ADFieldJobs.swapSpot(info.verts, vx, vz, target.x, target.z, ADFieldWork.SWAP_INSET_M)}
-- huskes: efter høst sættes skærebordet bag på samme frie sted
assignment.swapSpot = mountOpts.spot
end
elseif assignment.swapSpot ~= nil then
mountOpts = {spot = assignment.swapSpot}
end
local ok, started, why = pcall(mount, adEnv, assignment.vehicle, function(_, okSwap, text)
swap.done, swap.ok, swap.text = true, okSwap, text
@@ -2061,6 +2109,7 @@ function ADFieldWork.windDownHelpers(adEnv, fieldId, stage)
log(fieldId, "tømmevogn '%s' afbrudt under hentning — høsten er færdig", ADRuns.vehicleLabel(vehicle))
elseif assignment.helper and assignment.stage == stage then
if assignment.handle ~= nil then assignment.handle.cancelled = true end
assignment.cpStopIntended = true
ADCpBridge.stop(assignment.vehicle)
assignment.phase = "working"
assignment.idleSince = nil
+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))
+7 -1
View File
@@ -290,6 +290,10 @@ local function vehicleState(adEnv, vehicle, markerId)
distance = math.min(distance, math.sqrt((x - wayPoint.x) ^ 2 + (z - wayPoint.z) ^ 2))
end
end
local combinedLength = 0
for _, part in pairs(parts) do
combinedLength = combinedLength + (part.size ~= nil and tonumber(part.size.length) or 0)
end
local atLastWaypoint = false
local dpm = vehicle.ad ~= nil and vehicle.ad.drivePathModule or nil
if dpm ~= nil and dpm.getWayPoints ~= nil then
@@ -300,7 +304,9 @@ local function vehicleState(adEnv, vehicle, markerId)
local mode = module ~= nil and module.getMode ~= nil and module:getMode() or nil
return {
adActive = module ~= nil and module:isActive(),
lengthSlack = ADHitch.lengthSlack(vehicle.size ~= nil and vehicle.size.length or 0),
-- hele sættet: med en lang vogn bag (CARGOS 760) holder traktoren 14 m fra båsens P-markør, når den lige har
-- koblet vognen på ved Connect og AD straks melder fremme (in-game 10/10: 'stoppedAway (14 m)' fire gange)
lengthSlack = ADHitch.lengthSlack(combinedLength),
atLastWaypoint = atLastWaypoint,
distance = distance,
speed = vehicle.getLastSpeed ~= nil and vehicle:getLastSpeed() or 0,
+1 -1
View File
@@ -1,7 +1,7 @@
<?xml version="1.0" encoding="utf-8" standalone="no"?>
<modDesc descVersion="107">
<author>masterdraco</author>
<version>1.62.195.0</version>
<version>1.62.199.0</version>
<title>
<en>AD Smart Pickup</en>
</title>