feat: krybning følger båsens bakkevej ind til bagredskab ved skæv ankomst (v1.62.85)

This commit is contained in:
2026-10-08 10:39:45 +02:00
parent 7f1908ab0f
commit ab7be63a5d
3 changed files with 59 additions and 5 deletions
+57 -4
View File
@@ -138,6 +138,26 @@ function ADHitchCreep.reverseOutPath(getWp, startId)
return path
end
-- Bakkevejen IND i en bås fra dens Connect: følg bakkekanterne (også forbi punkter med forlæns udkørsel), til der ikke
-- er flere. Til krybning ind til et bagredskab, når traktoren står skævt (in-game 8/10: efter frontbåsens kurve stod
-- T7 3,2 m ved siden af bagklipperens trækøje; bagbåsen har bakkevejen 2104 -> 2105 -> 2106 -> 2107).
function ADHitchCreep.reverseChain(getWp, startId)
local current = getWp(startId)
local path, seen = {}, {[startId] = true}
while current ~= nil and #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)
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
@@ -356,20 +376,34 @@ end
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)
-- wagon (valgfri): bakkevej ind til et bagredskab — stopper, så snart spillet ser det inden for koblingsrækkevidde.
function ReverseOutTask.new(adEnv, vehicle, path, wagon)
return setmetatable({adEnv = adEnv, vehicle = vehicle, path = path, wagon = wagon, index = 1, elapsedMs = 0, stillMs = 0,
checkMs = 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])
Logging.info(ADHitchCreep.LOG_PREFIX .. "'%s' bakker %s ad %d vejpunkter (%d -> %d)", vehicleName(self.vehicle),
self.wagon ~= nil and ("ind til '" .. vehicleName(self.wagon) .. "'") or "ud af båsen", #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 self.wagon ~= nil then
if action == "inRange" or action == "done" then
Logging.info(ADHitchCreep.LOG_PREFIX .. "'%s' står ved '%s' (bakkevej, vejpunkt %d af %d) — kobler på", vehicleName(vehicle),
vehicleName(self.wagon), self.index, #self.path)
else
Logging.warning(ADHitchCreep.LOG_PREFIX .. "'%s' opgav at bakke ind til '%s' ved vejpunkt %d af %d", vehicleName(vehicle),
vehicleName(self.wagon), self.index, #self.path)
end
local taskModule = self.adEnv.ADTaskModule
vehicle.ad.taskModule:setCurrentTaskFinished(taskModule ~= nil and taskModule.DONT_PROPAGATE or 1)
return
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).
@@ -419,6 +453,13 @@ function ReverseOutTask:update(dt)
else
self.stillMs = self.stillMs + dt
end
if self.wagon ~= nil then
self.checkMs = self.checkMs + dt
if self.checkMs >= ADHitchCreep.RANGE_CHECK_MS then
self.checkMs = 0
if isInRange(vehicle, self.wagon) then return self:finish("inRange") end
end
end
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)
@@ -512,6 +553,18 @@ function ADHitchCreep.install(adEnv)
-- "Connect P Front Mower": frontkrogen og frem; ellers bagkrogen og bak (uændret)
local front = ADHitchCreep.isFrontMarker(job.markerName)
local target = ADHitchCreep.findTarget(self.vehicle, front)
-- skævt i forhold til båsen: følg båsens bakkevej fra Connect ind til redskabet
if target ~= nil and not front and target.plan == "none" and target.offset.z < 0 then
local graph = adEnv.ADGraphManager
local chain = ADHitchCreep.reverseChain(function(id) return graph:getWayPointById(id) end, self.destinationID)
local last = chain[#chain] ~= nil and graph:getWayPointById(chain[#chain]) or nil
local t = worldPos(target.target)
if last ~= nil and (last.x - t.x) ^ 2 + (last.z - t.z) ^ 2 <= ADHitchCreep.CREEP_MAX_DISTANCE ^ 2 then
job.crept = true
self.vehicle.ad.taskModule:addTask(ReverseOutTask.new(adEnv, self.vehicle, chain, target.wagon))
return
end
end
if target == nil or target.plan ~= "creep" then
-- hvorfor der ikke bakkes (in-game 6/10: Læssevogn 2 'noAttachable' uden bakning)
if target == nil then
+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.84.0</version>
<version>1.62.85.0</version>
<title>
<en>AD Smart Pickup</en>
</title>