feat: bak selv ud af blindgyde-bås (frontbås) før AD-turen (v1.62.83)
This commit is contained in:
@@ -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 — 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.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.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.
|
- **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.
|
||||||
|
|||||||
@@ -83,6 +83,67 @@ function ADHitchCreep.backOffStep(s)
|
|||||||
return "drive"
|
return "drive"
|
||||||
end
|
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 ----
|
-- ---- spil ----
|
||||||
|
|
||||||
local function worldPos(node)
|
local function worldPos(node)
|
||||||
@@ -290,21 +351,143 @@ local function blockingFrontImplement(vehicle)
|
|||||||
return nil
|
return nil
|
||||||
end
|
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)
|
function ADHitchCreep.backOffIfBlocked(adEnv, vehicle)
|
||||||
local taskModule = vehicle ~= nil and vehicle.ad ~= nil and vehicle.ad.taskModule or nil
|
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
|
if taskModule == nil or taskModule.tasks == nil then return false end
|
||||||
local implement = blockingFrontImplement(vehicle)
|
-- blindgyde-bås: bak ud ad dens bakkekanter (det klarer også et frontredskab lige foran)
|
||||||
if implement == nil then return false end
|
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
|
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),
|
Logging.warning(ADHitchCreep.LOG_PREFIX .. "'%s' skal bakke ud først, men AD kører allerede", vehicleName(vehicle))
|
||||||
vehicleName(implement))
|
|
||||||
return false
|
return false
|
||||||
end
|
end
|
||||||
local queued = {}
|
if #path > 0 then
|
||||||
while taskModule.tasks:Count() > 0 do table.insert(queued, taskModule.tasks:Dequeue()) end
|
enqueueFirst(taskModule, ReverseOutTask.new(adEnv, vehicle, path))
|
||||||
taskModule.tasks:Enqueue(BackOffTask.new(adEnv, vehicle, implement))
|
else
|
||||||
for _, task in ipairs(queued) do taskModule.tasks:Enqueue(task) end
|
enqueueFirst(taskModule, BackOffTask.new(adEnv, vehicle, implement))
|
||||||
|
end
|
||||||
return true
|
return true
|
||||||
end
|
end
|
||||||
|
|
||||||
|
|||||||
@@ -1,7 +1,7 @@
|
|||||||
<?xml version="1.0" encoding="utf-8" standalone="no"?>
|
<?xml version="1.0" encoding="utf-8" standalone="no"?>
|
||||||
<modDesc descVersion="107">
|
<modDesc descVersion="107">
|
||||||
<author>masterdraco</author>
|
<author>masterdraco</author>
|
||||||
<version>1.62.82.0</version>
|
<version>1.62.83.0</version>
|
||||||
<title>
|
<title>
|
||||||
<en>AD Smart Pickup</en>
|
<en>AD Smart Pickup</en>
|
||||||
</title>
|
</title>
|
||||||
|
|||||||
Reference in New Issue
Block a user