feat: bak selv ud af blindgyde-bås (frontbås) før AD-turen (v1.62.83)

This commit is contained in:
2026-10-08 10:28:00 +02:00
parent 8f7ad08d91
commit da9cd08d40
3 changed files with 194 additions and 10 deletions
+1
View File
@@ -8,6 +8,7 @@ står i [docs/BRUGERMANUAL.md](docs/BRUGERMANUAL.md) (dansk) og [docs/USER_MANUA
## 1.62 — Kæder slås selv til
- **1.62.83** Nyt: modden bakker selv ud af en blindgyde-bås. AutoDrive starter aldrig en tur baglæns: den vil have et vejpunkt foran traktoren og vender ellers med stifinderen (in-game 8/10: T7 drejede rundt i frontbåsen og kørte ind i bagklipperen). Er traktorens nærmeste vejpunkt en blindgyde (alle udkørsler er bakkekanter, fx "P Front Mower"), følger modden bakkekanterne baglæns, til vejen fortsætter forlæns, og giver så AD turen. Ender bakkevejen ved turens mål, regnes traktoren som fremme, så krybningen hen til bagklipperen starter med det samme. En frontbås kan dermed bygges som en almindelig bås, bare spejlvendt: forlæns ind, bak ud.
- **1.62.82** Rettet: krybningen frem til et frontredskab tillader nu op til 3 m sideværts forskydning, mod 1,5 m ved bakning. Fremad styrer traktoren mod koblingspunktet hele vejen, så forskydningen rettes op undervejs. KDF 341 stod 11,1 m foran og 1,8 m til siden og blev ikke koblet på (in-game 8/10).
- **1.62.81** Ændret: et klippersæt hentes nu med front først og bag bagefter. Udturen er hjemturen spejlvendt: traktoren kører forlæns ind og kobler frontklipperen, bakker ud gennem frontbåsens kurve og bakker den sidste del hen til bagklipperen. Med bag først kørte T7 ind i frontbåsen mod den parkerede frontklipper, fordi Connect P Rear Mower kun nås gennem frontbåsen (in-game 8/10). Hjem sættes stadig bag af først.
- **1.62.80** Ændret: et klippersæt kræver hk nok til begge klippernes samlede reelle PTO-forbrug, fordi spillet lægger det sammen på motoren. For KDD 941 + KDF 341 er det 70 + 35 kW ≈ 143 hk. Kendes PTO-tallene ikke, lægges butikkens anbefalede hk sammen. 1.62.79's regel om kun det tungeste redskab var for løs.
+192 -9
View File
@@ -83,6 +83,67 @@ function ADHitchCreep.backOffStep(s)
return "drive"
end
-- Bak ud af en blindgyde-bås (in-game 8/10: frontbåsen "P Front Mower" kører man forlæns ind i og bakker ud af ad
-- bakkekanter). AD starter aldrig en tur baglæns: findMatchingWayPointForVehicle vil kun have et vejpunkt FORAN
-- traktoren, ellers vender den med stifinderen. Modden følger derfor selv bakkekanterne ud, til vejen fortsætter
-- forlæns, og giver så AD turen.
ADHitchCreep.REVERSE_OUT_RADIUS = 8 -- m: blindgyde-vejpunkt så tæt på traktoren
ADHitchCreep.REVERSE_OUT_MAX_POINTS = 40
ADHitchCreep.REVERSE_OUT_REACHED_M = 1.5
ADHitchCreep.REVERSE_OUT_SPEED = 5 -- km/t
ADHitchCreep.REVERSE_OUT_TIMEOUT_MS = 90000
ADHitchCreep.REVERSE_OUT_STUCK_MS = 10000
local function contains(list, value)
for _, item in ipairs(list or {}) do if item == value then return true end end
return false
end
-- Bakkekant: AD's konvention — fra står i fra.out, men ikke i til.incoming.
function ADHitchCreep.isReverseEdge(fromId, toWp)
return toWp ~= nil and not contains(toWp.incoming, fromId)
end
-- Blindgyde: vejpunktet har udkørsler, og de er alle bakkekanter.
function ADHitchCreep.isDeadEnd(getWp, wp)
if wp == nil or wp.out == nil or #wp.out == 0 then return false end
for _, id in ipairs(wp.out) do
if not ADHitchCreep.isReverseEdge(wp.id, getWp(id)) then return false end
end
return true
end
-- Bakkevejen ud fra en blindgyde: følg bakkekanterne, til et vejpunkt har en forlæns udkørsel. -> {id, ...} (tom = ingen)
function ADHitchCreep.reverseOutPath(getWp, startId)
local current = getWp(startId)
if not ADHitchCreep.isDeadEnd(getWp, current) then return {} end
local path, seen = {}, {[startId] = true}
while #path < ADHitchCreep.REVERSE_OUT_MAX_POINTS do
local nextWp = nil
for _, id in ipairs(current.out or {}) do
local candidate = getWp(id)
if not seen[id] and ADHitchCreep.isReverseEdge(current.id, candidate) then nextWp = candidate break end
end
if nextWp == nil then break end
seen[nextWp.id] = true
table.insert(path, nextWp.id)
local forward = false
for _, id in ipairs(nextWp.out or {}) do
if not ADHitchCreep.isReverseEdge(nextWp.id, getWp(id)) then forward = true end
end
if forward then break end
current = nextWp
end
return path
end
-- s = {reached, last, elapsedMs, stillMs} -> "next" | "done" | "drive" | "giveUp"
function ADHitchCreep.reverseOutStep(s)
if s.reached then return s.last and "done" or "next" end
if (s.elapsedMs or 0) >= ADHitchCreep.REVERSE_OUT_TIMEOUT_MS or (s.stillMs or 0) >= ADHitchCreep.REVERSE_OUT_STUCK_MS then return "giveUp" end
return "drive"
end
-- ---- spil ----
local function worldPos(node)
@@ -290,21 +351,143 @@ local function blockingFrontImplement(vehicle)
return nil
end
-- Kaldes lige efter AD er startet: står et løst redskab foran, bakkes der fri først (opgaven lægges forrest).
-- Følg bakkevejen (vejpunkt for vejpunkt) baglæns ud af blindgyden.
local ReverseOutTask = {}
ReverseOutTask.__index = ReverseOutTask
function ReverseOutTask.new(adEnv, vehicle, path)
return setmetatable({adEnv = adEnv, vehicle = vehicle, path = path, index = 1, elapsedMs = 0, stillMs = 0}, ReverseOutTask)
end
function ReverseOutTask:setUp()
self.last = worldPos(self.vehicle.rootNode)
Logging.info(ADHitchCreep.LOG_PREFIX .. "'%s' bakker ud af båsen ad %d vejpunkter (%d -> %d)", vehicleName(self.vehicle), #self.path,
self.path[1], self.path[#self.path])
end
function ReverseOutTask:finish(action)
local vehicle = self.vehicle
local sdm = vehicle.ad.specialDrivingModule
if sdm ~= nil and sdm.stopVehicle ~= nil then sdm:stopVehicle() end
if action == "done" and self:endsAtDestination() then
-- bakkevejen ender ved turens mål (udturen: Connect P Rear Mower = 2104): fremme — AD må ikke køre en omvej
-- tilbage til et mål, den nu har bag sig. Køreopgaven fjernes, og AD's "fremme" kører (krybning + stop).
Logging.info(ADHitchCreep.LOG_PREFIX .. "'%s' er ude af båsen ved vejpunkt %d = turens mål — fremme", vehicleName(vehicle), self.path[#self.path])
local mode = vehicle.ad.stateModule:getCurrentMode()
local queued = {}
local taskModule = vehicle.ad.taskModule
while taskModule.tasks:Count() > 0 do
local task = taskModule.tasks:Dequeue()
if mode == nil or task ~= mode.driveToDestinationTask then table.insert(queued, task) end
end
for _, task in ipairs(queued) do taskModule.tasks:Enqueue(task) end
taskModule:setCurrentTaskFinished()
return
elseif action == "done" then
Logging.info(ADHitchCreep.LOG_PREFIX .. "'%s' er ude af båsen ved vejpunkt %d — AD overtager", vehicleName(vehicle), self.path[#self.path])
else
Logging.warning(ADHitchCreep.LOG_PREFIX .. "'%s' opgav at bakke ud af båsen ved vejpunkt %d af %d (%d s) — AD overtager",
vehicleName(vehicle), self.index, #self.path, math.floor(self.elapsedMs / 1000))
end
local taskModule = self.adEnv.ADTaskModule
vehicle.ad.taskModule:setCurrentTaskFinished(taskModule ~= nil and taskModule.DONT_PROPAGATE or 1)
end
-- Ender bakkevejen ved "Kør til"-turens mål (vejpunkt-id eller inden for 3 m)?
function ReverseOutTask:endsAtDestination()
local mode = self.vehicle.ad.stateModule ~= nil and self.vehicle.ad.stateModule:getCurrentMode() or nil
local destination = mode ~= nil and mode.destinationID or nil
if destination == nil or mode.driveToDestinationTask == nil then return false end
local lastId = self.path[#self.path]
if destination == lastId then return true end
local graph = self.adEnv.ADGraphManager
local a, b = graph:getWayPointById(destination), graph:getWayPointById(lastId)
return a ~= nil and b ~= nil and (a.x - b.x) ^ 2 + (a.z - b.z) ^ 2 <= 9
end
function ReverseOutTask:update(dt)
self.elapsedMs = self.elapsedMs + dt
local vehicle, autoDrive = self.vehicle, self.adEnv.AutoDrive
local wp = self.adEnv.ADGraphManager:getWayPointById(self.path[self.index])
if wp == nil then return self:finish("giveUp") end
local p = worldPos(vehicle.rootNode)
self.stillMs = (math.abs(p.x - self.last.x) + math.abs(p.z - self.last.z) < 0.02) and self.stillMs + dt or 0
self.last = p
local _, _, lz = worldToLocal(vehicle.rootNode, wp.x, p.y, wp.z)
local distance = math.sqrt((p.x - wp.x) ^ 2 + (p.z - wp.z) ^ 2)
-- nået: tæt nok på, eller kørt forbi (vejpunktet ligger nu foran traktoren, når den bakker)
local action = ADHitchCreep.reverseOutStep({reached = distance <= ADHitchCreep.REVERSE_OUT_REACHED_M or lz > 0.5,
last = self.index >= #self.path, elapsedMs = self.elapsedMs, stillMs = self.stillMs})
if action == "next" then
self.index = self.index + 1
return
elseif action ~= "drive" then
return self:finish(action)
end
local sdm = vehicle.ad.specialDrivingModule
if sdm ~= nil and sdm.releaseVehicle ~= nil then sdm:releaseVehicle() end
if vehicle.startMotor ~= nil and not vehicle:getIsMotorStarted() and vehicle:getCanMotorRun() then vehicle:startMotor() end
local lx, lzDir = autoDrive.getDriveDirection(vehicle, wp.x, wp.y or p.y, wp.z)
autoDrive.driveInDirection(vehicle, dt, 30, 0.3, 0.2, 20, true, false, -lx, -lzDir, ADHitchCreep.REVERSE_OUT_SPEED, 1)
end
function ReverseOutTask:abort() end
function ReverseOutTask:finished() end
function ReverseOutTask:getInfoText() return "Bakker ud af båsen" end
function ReverseOutTask:getI18nInfo() return "" end
function ReverseOutTask:getExcludedVehiclesForCollisionCheck() return {} end
-- Står traktoren i en blindgyde-bås? -> bakkevej (tom = nej). Nærmeste blindgyde-vejpunkt inden for radius.
local function reverseOutPathFor(adEnv, vehicle)
local graph = adEnv.ADGraphManager
if graph == nil or graph.getWayPointsInRange == nil or vehicle.rootNode == nil then return {} end
local p = worldPos(vehicle.rootNode)
local getWp = function(id) return graph:getWayPointById(id) end
-- kun når det NÆRMESTE vejpunkt er en blindgyde (en traktor i en almindelig bås står ved et punkt med forlæns
-- udkørsel og må aldrig sendes baglæns længere ind ad båsens indkørsel)
local best, bestDistance = nil, nil
for _, id in ipairs(graph:getWayPointsInRange({x = p.x, z = p.z}, 0, ADHitchCreep.REVERSE_OUT_RADIUS) or {}) do
local wp = getWp(id)
if wp ~= nil then
local distance = (wp.x - p.x) ^ 2 + (wp.z - p.z) ^ 2
if bestDistance == nil or distance < bestDistance then best, bestDistance = wp, distance end
end
end
if best == nil or not ADHitchCreep.isDeadEnd(getWp, best) then return {} end
local path = ADHitchCreep.reverseOutPath(getWp, best.id)
-- bakkevejen skal begynde bag traktoren
local first = path[1] ~= nil and getWp(path[1]) or nil
if first == nil then return {} end
local _, _, lz = worldToLocal(vehicle.rootNode, first.x, p.y, first.z)
if lz > 0 then return {} end
return path
end
local function enqueueFirst(taskModule, task)
local queued = {}
while taskModule.tasks:Count() > 0 do table.insert(queued, taskModule.tasks:Dequeue()) end
taskModule.tasks:Enqueue(task)
for _, item in ipairs(queued) do taskModule.tasks:Enqueue(item) end
end
-- Kaldes lige efter AD er startet (før vækningen): blindgyde-bås -> bak ud ad bakkekanterne; ellers løst redskab lige
-- foran -> bak lige fri. Opgaven lægges forrest i AD's kø.
function ADHitchCreep.backOffIfBlocked(adEnv, vehicle)
local taskModule = vehicle ~= nil and vehicle.ad ~= nil and vehicle.ad.taskModule or nil
if taskModule == nil or taskModule.tasks == nil then return false end
local implement = blockingFrontImplement(vehicle)
if implement == nil then return false end
-- blindgyde-bås: bak ud ad dens bakkekanter (det klarer også et frontredskab lige foran)
local path = reverseOutPathFor(adEnv, vehicle)
local implement = #path == 0 and blockingFrontImplement(vehicle) or nil
if #path == 0 and implement == nil then return false end
if taskModule:getActiveTask() ~= nil then
Logging.warning(ADHitchCreep.LOG_PREFIX .. "'%s' har '%s' lige foran, men AD kører allerede — bakker ikke fri", vehicleName(vehicle),
vehicleName(implement))
Logging.warning(ADHitchCreep.LOG_PREFIX .. "'%s' skal bakke ud først, men AD kører allerede", vehicleName(vehicle))
return false
end
local queued = {}
while taskModule.tasks:Count() > 0 do table.insert(queued, taskModule.tasks:Dequeue()) end
taskModule.tasks:Enqueue(BackOffTask.new(adEnv, vehicle, implement))
for _, task in ipairs(queued) do taskModule.tasks:Enqueue(task) end
if #path > 0 then
enqueueFirst(taskModule, ReverseOutTask.new(adEnv, vehicle, path))
else
enqueueFirst(taskModule, BackOffTask.new(adEnv, vehicle, implement))
end
return true
end
+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.82.0</version>
<version>1.62.83.0</version>
<title>
<en>AD Smart Pickup</en>
</title>