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
+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>