feat: pålæsning ruller frem til læssetriggeren (ADLoadRoll) — 1.62.290
In-game 17/10: 'Slurry 2' (1050 Vario + Supercis 800) holdt 2,2 m fra 'Slurry Tank'-triggeren uden at fylde; AD fylder kun med exactFillRootNode i triggerens form. Som ADUnloadRoll: ved målet uden fyldning 1,5 s -> trigger med varen 0,3-8 m foran -> rul 3 km/t til AD fylder/i boksen; giv op efter 20 s/1,5 m forbi; ét forsøg pr. tur; ikke autoload. Trigger bagved logges med afstand (flyt markøren). inBox pr. fyldenhed (review). Installeret yderst om LoadAtDestinationTask.update.
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.290** Nyt: **pålæsning ruller frem til læssetriggeren** (in-game 17/10: 'Slurry 2' med Supercis 800 holdt 2,2 m fra 'Slurry Tank'-triggeren uden at fylde — AutoDrive fylder kun, når vognens påfyldningspunkt står inde i triggerens form, og markøren skulle sidde på meteren). Står toget ved markøren uden at fylde, og en læssetrigger med varen er 0,3–8 m foran påfyldningspunktet, ruller traktoren langsomt frem, til AutoDrive fylder (som aflæsnings-rulningen). Sidder triggeren bagved, logges "flyt markøren X m tilbage". Ikke for autoload-vogne.
|
||||||
- **1.62.289** Diagnose: **frame-hul logges** (brugerobs. 17/10: spillet fryser nogle gange, når man kommer tilbage efter et dagsskifte). Går der over 1 s mellem to frames, skriver loggen hullets længde, hvor meget af tiden moddens målte indgange brugte, og om spillet sov, var i pause eller i en menu — så det kan ses, om frysningen er moddens eller spillets. Højst 5 linjer pr. minut.
|
- **1.62.289** Diagnose: **frame-hul logges** (brugerobs. 17/10: spillet fryser nogle gange, når man kommer tilbage efter et dagsskifte). Går der over 1 s mellem to frames, skriver loggen hullets længde, hvor meget af tiden moddens målte indgange brugte, og om spillet sov, var i pause eller i en menu — så det kan ses, om frysningen er moddens eller spillets. Højst 5 linjer pr. minut.
|
||||||
- **1.62.288** Rettet: **ingen markmaskine kunne starte AutoDrive i 1.62.287** (in-game 17/10 04:06: "error in error handling" ved hjemtur og udsendelse — en omviser til `startAd`, lagt ind for profileringen, pegede på sig selv). Ny test fanger det.
|
- **1.62.288** Rettet: **ingen markmaskine kunne starte AutoDrive i 1.62.287** (in-game 17/10 04:06: "error in error handling" ved hjemtur og udsendelse — en omviser til `startAd`, lagt ind for profileringen, pegede på sig selv). Ny test fanger det.
|
||||||
- **1.62.287** Ydelse: **samme kur for markør-til-markør-ruter** (in-game 17/10 med 286: værste frame 858 ms fra "rutetjek frem+tilbage" — AutoDrives pathFromTo over 48.000 vejpunkter). Vejnettets egen søgning spørges først, også for ruten mål -> hjem og for udkørslens turvalg.
|
- **1.62.287** Ydelse: **samme kur for markør-til-markør-ruter** (in-game 17/10 med 286: værste frame 858 ms fra "rutetjek frem+tilbage" — AutoDrives pathFromTo over 48.000 vejpunkter). Vejnettets egen søgning spørges først, også for ruten mål -> hjem og for udkørslens turvalg.
|
||||||
|
|||||||
@@ -0,0 +1,224 @@
|
|||||||
|
-- AD Load Roll
|
||||||
|
-- AutoDrive standser pålæsningen, når traktorens NÆSE når markøren, og fylder kun, når vognens påfyldningspunkt
|
||||||
|
-- (FillUnit exactFillRootNode) fysisk står inde i læssetriggerens form (LoadTrigger.fillableObjects). Med en lang
|
||||||
|
-- gyllevogn (1050 Vario + Supercis 800, in-game 17/10 ved 'Slurry Tank'/Silo 2) stod tanken 2,2 m fra triggeren
|
||||||
|
-- uden at være i boksen — AD ventede, og efter 30 s sprang udkørslen kilden over. Markøren skal ellers sidde på
|
||||||
|
-- meteren (brugerobs. 17/10: "et meget præcist sted den skal holde"). Står en læssetrigger med varen få meter FORAN
|
||||||
|
-- påfyldningspunktet, ruller traktoren her langsomt frem, til AD selv begynder at fylde. Som ADUnloadRoll.
|
||||||
|
-- Ligger triggeren BAGVED (markøren sidder for langt fremme), rulles der ikke — det logges med afstanden, så
|
||||||
|
-- markøren kan flyttes.
|
||||||
|
|
||||||
|
ADLoadRoll = {}
|
||||||
|
ADLoadRoll.LOG_PREFIX = "ADSmartPickup: pålæsning: "
|
||||||
|
ADLoadRoll.MIN_AHEAD = 0.3 -- m: tættere på er påfyldningspunktet allerede over triggeren
|
||||||
|
ADLoadRoll.MAX_AHEAD = 8 -- m: længere frem rulles ikke — så er det ikke markørens trigger
|
||||||
|
ADLoadRoll.MAX_LATERAL = 2.5 -- m til siden: vognen følger sporet lige frem
|
||||||
|
ADLoadRoll.MAX_BEHIND = 8 -- m bagud: så langt bagude nævnes triggeren i loggen (flyt markøren)
|
||||||
|
ADLoadRoll.OVERSHOOT = 1.5 -- m forbi planen uden at AD fylder -> giv op
|
||||||
|
ADLoadRoll.TIMEOUT_MS = 20000
|
||||||
|
ADLoadRoll.SETTLE_MS = 1500 -- målet nået så længe, uden at AD fylder, før der rulles
|
||||||
|
ADLoadRoll.ROLL_SPEED = 3 -- km/t
|
||||||
|
ADLoadRoll.SEARCH_RADIUS = 14 -- m fra påfyldningspunktet til triggere der overvejes
|
||||||
|
|
||||||
|
-- ---- ren logik ----
|
||||||
|
|
||||||
|
-- offsets = {{x, z, inBox}}: læssetriggere med varen set fra en vogns påfyldningspunkt i traktorens rum (z > 0 = foran).
|
||||||
|
-- -> meter der skal rulles (nærmeste brugbare), eller nil. Står et påfyldningspunkt allerede i en boks, rulles ikke.
|
||||||
|
function ADLoadRoll.plan(offsets)
|
||||||
|
local best = nil
|
||||||
|
for _, offset in ipairs(offsets or {}) do
|
||||||
|
if offset.inBox then return nil end
|
||||||
|
if offset.z > ADLoadRoll.MIN_AHEAD and offset.z <= ADLoadRoll.MAX_AHEAD
|
||||||
|
and math.abs(offset.x) <= ADLoadRoll.MAX_LATERAL and (best == nil or offset.z < best) then
|
||||||
|
best = offset.z
|
||||||
|
end
|
||||||
|
end
|
||||||
|
return best
|
||||||
|
end
|
||||||
|
|
||||||
|
-- Nærmeste trigger BAGVED påfyldningspunktet (markøren sidder for langt fremme) -> meter, eller nil
|
||||||
|
function ADLoadRoll.behind(offsets)
|
||||||
|
local best = nil
|
||||||
|
for _, offset in ipairs(offsets or {}) do
|
||||||
|
if not offset.inBox and offset.z < -ADLoadRoll.MIN_AHEAD and offset.z >= -ADLoadRoll.MAX_BEHIND
|
||||||
|
and math.abs(offset.x) <= ADLoadRoll.MAX_LATERAL and (best == nil or -offset.z < best) then
|
||||||
|
best = -offset.z
|
||||||
|
end
|
||||||
|
end
|
||||||
|
return best
|
||||||
|
end
|
||||||
|
|
||||||
|
-- s = {loading, traveled, planned, elapsedMs} -> "done" | "drive" | "giveUp"
|
||||||
|
function ADLoadRoll.step(s)
|
||||||
|
if s.loading then return "done" end
|
||||||
|
if (s.elapsedMs or 0) >= ADLoadRoll.TIMEOUT_MS then return "giveUp" end
|
||||||
|
if s.traveled > s.planned + ADLoadRoll.OVERSHOOT then return "giveUp" end
|
||||||
|
return "drive"
|
||||||
|
end
|
||||||
|
|
||||||
|
-- ---- spil ----
|
||||||
|
|
||||||
|
local rolls = setmetatable({}, {__mode = "k"}) -- køretøj -> {task, start, planned, elapsedMs}
|
||||||
|
local tried = setmetatable({}, {__mode = "k"}) -- pålæsningsopgave -> true (kun ét forsøg pr. tur)
|
||||||
|
local settle = setmetatable({}, {__mode = "k"}) -- pålæsningsopgave -> ms med målet nået uden fyldning
|
||||||
|
|
||||||
|
local function vehicleName(vehicle)
|
||||||
|
if ADRuns ~= nil and ADRuns.vehicleLabel ~= nil then return tostring(ADRuns.vehicleLabel(vehicle)) end
|
||||||
|
return ADUtil.vehicleName(vehicle)
|
||||||
|
end
|
||||||
|
|
||||||
|
-- Som AutoDrive.trailerIsInTriggerList: netop DENNE fyldenhed skal stå i boksen (review 17/10: en anden enhed på samme
|
||||||
|
-- vogn i boksen talte ellers som fremme)
|
||||||
|
local function inBox(trigger, trailer, fillUnitIndex)
|
||||||
|
for key, entry in pairs(trigger.fillableObjects or {}) do
|
||||||
|
if key == trailer then return true end
|
||||||
|
if type(entry) == "table" and entry.object == trailer and (entry.fillUnitIndex == nil or entry.fillUnitIndex == fillUnitIndex) then
|
||||||
|
return true
|
||||||
|
end
|
||||||
|
end
|
||||||
|
return false
|
||||||
|
end
|
||||||
|
|
||||||
|
-- Vognens påfyldningspunkt for fyldenheden: det node, der skal ind i triggerens form.
|
||||||
|
local function fillNode(trailer, fillUnitIndex)
|
||||||
|
local node = trailer.getFillUnitExactFillRootNode ~= nil and trailer:getFillUnitExactFillRootNode(fillUnitIndex) or nil
|
||||||
|
if node == nil and trailer.getFillUnitRootNode ~= nil then node = trailer:getFillUnitRootNode(fillUnitIndex) end
|
||||||
|
return node or trailer.rootNode
|
||||||
|
end
|
||||||
|
|
||||||
|
-- Læssetriggere med varen nær vognenes påfyldningspunkter, i traktorens rum. -> {{x, z, inBox}}
|
||||||
|
local function offsetsFor(adEnv, vehicle, task)
|
||||||
|
local offsets = {}
|
||||||
|
local manager = adEnv.ADTriggerManager
|
||||||
|
if manager == nil or manager.getLoadTriggers == nil or vehicle.rootNode == nil then return offsets end
|
||||||
|
local fillType = vehicle.ad.stateModule.getFillType ~= nil and vehicle.ad.stateModule:getFillType() or nil
|
||||||
|
if fillType == nil then return offsets end
|
||||||
|
for _, trailer in ipairs(task.trailers or {}) do
|
||||||
|
for i = 1, #(trailer.getFillUnits ~= nil and trailer:getFillUnits() or {}) do
|
||||||
|
local supports = trailer.getFillUnitSupportsFillType == nil or trailer:getFillUnitSupportsFillType(i, fillType)
|
||||||
|
local free = trailer.getFillUnitFreeCapacity ~= nil and trailer:getFillUnitFreeCapacity(i) or 1
|
||||||
|
local node = supports and free > 0 and fillNode(trailer, i) or nil
|
||||||
|
if node ~= nil then
|
||||||
|
local nx, _, nz = getWorldTranslation(node)
|
||||||
|
for _, trigger in pairs(manager.getLoadTriggers() or {}) do
|
||||||
|
if manager.triggerSupportsFillType(trigger, fillType) then
|
||||||
|
local tx, _, tz = manager.getTriggerPos(trigger)
|
||||||
|
if tx ~= nil and (tx ~= 0 or tz ~= 0) and math.sqrt((tx - nx) ^ 2 + (tz - nz) ^ 2) <= ADLoadRoll.SEARCH_RADIUS then
|
||||||
|
local x, _, z = worldDirectionToLocal(vehicle.rootNode, tx - nx, 0, tz - nz)
|
||||||
|
table.insert(offsets, {x = x, z = z, inBox = inBox(trigger, trailer, i)})
|
||||||
|
end
|
||||||
|
end
|
||||||
|
end
|
||||||
|
end
|
||||||
|
end
|
||||||
|
end
|
||||||
|
return offsets
|
||||||
|
end
|
||||||
|
|
||||||
|
local function isAdLoading(vehicle)
|
||||||
|
local trailerModule = vehicle.ad ~= nil and vehicle.ad.trailerModule or nil
|
||||||
|
if trailerModule == nil then return false end
|
||||||
|
return trailerModule.isLoading == true or (trailerModule.isActiveAtTrigger ~= nil and trailerModule:isActiveAtTrigger() == true)
|
||||||
|
end
|
||||||
|
|
||||||
|
local function positionOf(vehicle)
|
||||||
|
local x, _, z = getWorldTranslation(vehicle.rootNode)
|
||||||
|
return {x = x, z = z}
|
||||||
|
end
|
||||||
|
|
||||||
|
-- Skal opgaven rulle frem nu? -> planlagt afstand eller nil
|
||||||
|
local function shouldRoll(adEnv, task, dt)
|
||||||
|
local vehicle = task.vehicle
|
||||||
|
if tried[task] or task.state ~= (task.STATE_DRIVING or 2) or vehicle.ad.hasAL then return nil end
|
||||||
|
if vehicle.ad.drivePathModule == nil or not vehicle.ad.drivePathModule:isTargetReached() or isAdLoading(vehicle) then
|
||||||
|
settle[task] = 0
|
||||||
|
return nil
|
||||||
|
end
|
||||||
|
settle[task] = (settle[task] or 0) + dt
|
||||||
|
if settle[task] < ADLoadRoll.SETTLE_MS then return nil end
|
||||||
|
tried[task] = true
|
||||||
|
local offsets = offsetsFor(adEnv, vehicle, task)
|
||||||
|
local planned = ADLoadRoll.plan(offsets)
|
||||||
|
if planned == nil then
|
||||||
|
local behind = ADLoadRoll.behind(offsets)
|
||||||
|
if behind ~= nil then
|
||||||
|
local marker = adEnv.ADGraphManager:getMapMarkerByWayPointId(task.destinationID)
|
||||||
|
Logging.info(ADLoadRoll.LOG_PREFIX .. "'%s' står %.1f m FORBI læssetriggeren — flyt markøren '%s' så langt tilbage", vehicleName(vehicle),
|
||||||
|
behind, tostring(marker ~= nil and marker.name or task.destinationID))
|
||||||
|
end
|
||||||
|
end
|
||||||
|
return planned
|
||||||
|
end
|
||||||
|
|
||||||
|
local function stop(vehicle, dt)
|
||||||
|
local sdm = vehicle.ad.specialDrivingModule
|
||||||
|
if sdm ~= nil and sdm.stopVehicle ~= nil then
|
||||||
|
sdm:stopVehicle()
|
||||||
|
if sdm.update ~= nil then sdm:update(dt) end
|
||||||
|
end
|
||||||
|
end
|
||||||
|
|
||||||
|
-- Ét skridt af rulningen. -> true når den er slut (AD overtager igen)
|
||||||
|
local function rollStep(adEnv, task, roll, dt)
|
||||||
|
local vehicle = task.vehicle
|
||||||
|
roll.elapsedMs = roll.elapsedMs + dt
|
||||||
|
-- AD's egen pålæsning må gerne gå i gang undervejs (getTriggerAndTrailerPairs -> tryLoadingAtTrigger)
|
||||||
|
if vehicle.ad.trailerModule ~= nil then vehicle.ad.trailerModule:update(dt) end
|
||||||
|
local p = positionOf(vehicle)
|
||||||
|
local traveled = math.sqrt((p.x - roll.start.x) ^ 2 + (p.z - roll.start.z) ^ 2)
|
||||||
|
local loading = isAdLoading(vehicle)
|
||||||
|
if not loading then
|
||||||
|
for _, offset in ipairs(offsetsFor(adEnv, vehicle, task)) do
|
||||||
|
if offset.inBox then loading = true break end -- i boksen: AD fylder ved næste forsøg
|
||||||
|
end
|
||||||
|
end
|
||||||
|
local action = ADLoadRoll.step({loading = loading, traveled = traveled, planned = roll.planned, elapsedMs = roll.elapsedMs})
|
||||||
|
if action == "done" then
|
||||||
|
stop(vehicle, dt)
|
||||||
|
Logging.info(ADLoadRoll.LOG_PREFIX .. "'%s' rullede %.1f m frem og står nu i læssetriggeren", vehicleName(vehicle), traveled)
|
||||||
|
return true
|
||||||
|
elseif action == "giveUp" then
|
||||||
|
stop(vehicle, dt)
|
||||||
|
Logging.warning(ADLoadRoll.LOG_PREFIX .. "'%s' rullede %.1f m uden at nå læssetriggeren — giver op", vehicleName(vehicle), traveled)
|
||||||
|
return true
|
||||||
|
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 x, y, z = localToWorld(vehicle.rootNode, 0, 0, 10)
|
||||||
|
local lx, lz = adEnv.AutoDrive.getDriveDirection(vehicle, x, y, z)
|
||||||
|
adEnv.AutoDrive.driveInDirection(vehicle, dt, 30, 0.3, 0.2, 20, true, true, lx, lz, ADLoadRoll.ROLL_SPEED, 1)
|
||||||
|
return false
|
||||||
|
end
|
||||||
|
|
||||||
|
local isInstalled = false
|
||||||
|
|
||||||
|
function ADLoadRoll.install(adEnv)
|
||||||
|
local task = adEnv ~= nil and adEnv.LoadAtDestinationTask or nil
|
||||||
|
if isInstalled or task == nil or task.update == nil or adEnv.AutoDrive == nil or adEnv.ADTriggerManager == nil
|
||||||
|
or adEnv.AutoDrive.driveInDirection == nil or adEnv.AutoDrive.getDriveDirection == nil then
|
||||||
|
return
|
||||||
|
end
|
||||||
|
isInstalled = true
|
||||||
|
local originalUpdate = task.update
|
||||||
|
task.update = function(self, dt)
|
||||||
|
local vehicle = self.vehicle
|
||||||
|
local roll = vehicle ~= nil and rolls[vehicle] or nil
|
||||||
|
if roll ~= nil and roll.task == self then
|
||||||
|
local ok, finished = pcall(rollStep, adEnv, self, roll, dt)
|
||||||
|
if not ok then Logging.warning(ADLoadRoll.LOG_PREFIX .. "rul frem: %s", tostring(finished)) end
|
||||||
|
if ok and not finished then return end
|
||||||
|
rolls[vehicle] = nil
|
||||||
|
elseif vehicle ~= nil and vehicle.ad ~= nil then
|
||||||
|
local ok, planned = pcall(shouldRoll, adEnv, self, dt)
|
||||||
|
if not ok then
|
||||||
|
Logging.warning(ADLoadRoll.LOG_PREFIX .. "rul frem: %s", tostring(planned))
|
||||||
|
elseif planned ~= nil then
|
||||||
|
rolls[vehicle] = {task = self, start = positionOf(vehicle), planned = planned, elapsedMs = 0}
|
||||||
|
Logging.info(ADLoadRoll.LOG_PREFIX .. "'%s' står %.1f m før læssetriggeren — ruller frem", vehicleName(vehicle), planned)
|
||||||
|
return
|
||||||
|
end
|
||||||
|
end
|
||||||
|
return originalUpdate(self, dt)
|
||||||
|
end
|
||||||
|
end
|
||||||
@@ -1656,6 +1656,10 @@ local function installHook(adEnv)
|
|||||||
if ADLoadDiag ~= nil and ADLoadDiag.install ~= nil then
|
if ADLoadDiag ~= nil and ADLoadDiag.install ~= nil then
|
||||||
ADLoadDiag.install(adEnv)
|
ADLoadDiag.install(adEnv)
|
||||||
end
|
end
|
||||||
|
-- yderst: mens toget ruller frem til læssetriggeren, springes udkørslens "intet at læsse"-tælling og diagnosen over
|
||||||
|
if ADLoadRoll ~= nil and ADLoadRoll.install ~= nil then
|
||||||
|
ADLoadRoll.install(adEnv)
|
||||||
|
end
|
||||||
|
|
||||||
Logging.info(ADSmartPickup.LOG_PREFIX .. "aktiv (mindst fyldte silo med varen; flere valgte varer = behovsstyret forsyning; Wait-punkter for rest-læs; udkørsel til silo/salg)")
|
Logging.info(ADSmartPickup.LOG_PREFIX .. "aktiv (mindst fyldte silo med varen; flere valgte varer = behovsstyret forsyning; Wait-punkter for rest-læs; udkørsel til silo/salg)")
|
||||||
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.289.0</version>
|
<version>1.62.290.0</version>
|
||||||
<title>
|
<title>
|
||||||
<en>AD Smart Pickup</en>
|
<en>AD Smart Pickup</en>
|
||||||
</title>
|
</title>
|
||||||
@@ -37,6 +37,7 @@
|
|||||||
<sourceFile filename="adOutbound.lua"/>
|
<sourceFile filename="adOutbound.lua"/>
|
||||||
<sourceFile filename="adTipSide.lua"/>
|
<sourceFile filename="adTipSide.lua"/>
|
||||||
<sourceFile filename="adLoadDiag.lua"/>
|
<sourceFile filename="adLoadDiag.lua"/>
|
||||||
|
<sourceFile filename="adLoadRoll.lua"/>
|
||||||
<sourceFile filename="adSellBlock.lua"/>
|
<sourceFile filename="adSellBlock.lua"/>
|
||||||
<sourceFile filename="adUnloadWait.lua"/>
|
<sourceFile filename="adUnloadWait.lua"/>
|
||||||
<sourceFile filename="adUnloadRoll.lua"/>
|
<sourceFile filename="adUnloadRoll.lua"/>
|
||||||
|
|||||||
Reference in New Issue
Block a user