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:
@@ -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))
|
||||
|
||||
Reference in New Issue
Block a user