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