Files
fs25-adsmartpickup/FS25_ADSmartPickup/adFillFold.lua
T

159 lines
8.4 KiB
Lua

-- AD Fill Fold
-- Redskaber hvis tank kun kan fyldes udfoldet (FillUnit#foldMinLimit/foldMaxLimit, fx Bednar Omega-såmaskinen): AutoDrive
-- folder ikke ud ved påfyldning, så maskinen holdt ved stationen uden at blive fyldt (in-game 16/10). Når en markopgaves
-- AD-tur i påfyldnings-tilstand er ved påfyldningsmarkøren, foldes redskabet så meget ud at tanken kan fyldes; når den
-- kører derfra igen (og Courseplay ikke arbejder), foldes det sammen til vejen. Ren logik øverst, spil-adapter nederst.
ADFillFold = {}
ADFillFold.LOG_PREFIX = "ADSmartPickup: påfyldning: "
ADFillFold.NEAR_M = 15 -- så tæt på påfyldningsmarkøren foldes ud (ikke mens den kører ind mod stationen)
ADFillFold.FAR_M = 60 -- så langt væk igen foldes sammen
ADFillFold.TICK_MS = 1000
ADFillFold.EMPTY_WAIT_MS = 45000 -- holder vognen ved påfyldningen så længe uden at fyldet stiger: stedet er tomt
ADFillFold.EMPTY_NEAR_M = 25 -- "ved påfyldningen" for tom-tjekket (AD holder ved triggeren, ikke altid ved markøren)
-- Ren: er påfyldningsstedet tomt? s = {loading, distance, level, lastLevel, stillMs} -> "wait" | "empty" | "none"
function ADFillFold.emptyCheck(s)
if not s.loading or (s.distance or math.huge) > ADFillFold.EMPTY_NEAR_M then return "none" end
if s.lastLevel ~= nil and (s.level or 0) > s.lastLevel + 1 then return "none" end -- fyldes: alt vel
if (s.stillMs or 0) >= ADFillFold.EMPTY_WAIT_MS then return "empty" end
return "wait"
end
-- Ren: foldens animationstid t og tankens tilladte interval [min, max] -> retning (1/-1) der skal til, eller nil.
function ADFillFold.foldDirection(t, min, max)
if t == nil or min == nil or max == nil then return nil end
if t < min then return 1 end
if t > max then return -1 end
return nil
end
-- Ren: s = {loading, distance, needsUnfold, unfoldedByUs, cpWorking} -> "unfold" | "fold" | "none"
function ADFillFold.action(s)
if s.unfoldedByUs then
if s.cpWorking then return "none" end
if not s.loading or (s.distance or math.huge) > ADFillFold.FAR_M then return "fold" end
return "none"
end
if s.loading and s.needsUnfold and (s.distance or math.huge) <= ADFillFold.NEAR_M then return "unfold" end
return "none"
end
-- ---- spil-adapter ----
local refillWatch = setmetatable({}, {__mode = "k"}) -- køretøj -> {level, since} ved påfyldningsmarkøren
local unfolded = setmetatable({}, {__mode = "k"}) -- køretøj -> {{object, direction}} vi har foldet ud til påfyldning
local timerMs, clockMs = 0, 0
-- Redskaber på traktoren hvis tank ikke kan fyldes i den nuværende foldestilling: {object, direction}
local function blockedByFold(vehicle)
local list = {}
for _, implement in ipairs(ADHitch.directImplementsOf(vehicle) or {}) do
local object = implement.object
local fillSpec = object ~= nil and object.spec_fillUnit or nil
if fillSpec ~= nil and object.spec_foldable ~= nil and object.getFoldAnimTime ~= nil and object.setFoldDirection ~= nil then
local t = object:getFoldAnimTime()
for _, unit in ipairs(fillSpec.fillUnits or {}) do
local direction = ADFillFold.foldDirection(t, unit.foldMinLimit, unit.foldMaxLimit)
if direction ~= nil then
table.insert(list, {object = object, direction = direction})
break
end
end
end
end
return list
end
-- Præcis den modsatte vej af udfoldningen (foldForTransport folder kun et helt udfoldet redskab — halvt åbent blev
-- stående, review 16/10).
local function foldBack(vehicle)
local entries = unfolded[vehicle]
unfolded[vehicle] = nil
for _, entry in ipairs(entries or {}) do
pcall(function() entry.object:setFoldDirection(-entry.direction) end)
end
end
local function refillDistance(adEnv, vehicle)
local module = vehicle.ad ~= nil and vehicle.ad.stateModule or nil
if module == nil or not module:isActive() or module:getMode() ~= adEnv.AutoDrive.MODE_LOAD then return false, nil end
local marker = module.getSecondMarker ~= nil and module:getSecondMarker() or nil
local wayPoint = marker ~= nil and marker.id ~= nil and adEnv.ADGraphManager:getWayPointById(marker.id) or nil
if wayPoint == nil or vehicle.rootNode == nil then return true, nil end
local x, _, z = getWorldTranslation(vehicle.rootNode)
return true, math.sqrt((wayPoint.x - x) ^ 2 + (wayPoint.z - z) ^ 2)
end
local function watchEmptyRefill(adEnv, vehicle, loading, distance, now)
local module = vehicle.ad ~= nil and vehicle.ad.stateModule or nil
local fillType = module ~= nil and module.getFillType ~= nil and module:getFillType() or nil
local level = (fillType ~= nil and ADCpBridge ~= nil and ADCpBridge.getRefillLevel ~= nil) and (ADCpBridge.getRefillLevel(vehicle, fillType) or 0) or 0
local watch = refillWatch[vehicle]
local check = ADFillFold.emptyCheck({loading = loading, distance = distance, level = level,
lastLevel = watch ~= nil and watch.level or nil, stillMs = watch ~= nil and (now - watch.since) or 0})
if check == "none" then
refillWatch[vehicle] = (loading and distance ~= nil and distance <= ADFillFold.EMPTY_NEAR_M) and {level = level, since = now} or nil
elseif check == "wait" then
if watch == nil then refillWatch[vehicle] = {level = level, since = now} end
else
refillWatch[vehicle] = nil
if ADFieldWork.retargetEmptyRefill ~= nil then
local ok, err = pcall(ADFieldWork.retargetEmptyRefill, adEnv, vehicle)
if not ok then Logging.warning(ADFillFold.LOG_PREFIX .. "tomt påfyldningssted: %s", tostring(err)) end
end
end
end
local function tickVehicle(adEnv, vehicle, now)
local loading, distance = refillDistance(adEnv, vehicle)
watchEmptyRefill(adEnv, vehicle, loading, distance, now)
local blocked = (loading and distance ~= nil and distance <= ADFillFold.NEAR_M) and blockedByFold(vehicle) or {}
local action = ADFillFold.action({loading = loading, distance = distance, needsUnfold = #blocked > 0,
unfoldedByUs = unfolded[vehicle] ~= nil, cpWorking = ADCpBridge ~= nil and ADCpBridge.isWorking(vehicle)})
if action == "unfold" then
for _, entry in ipairs(blocked) do entry.object:setFoldDirection(entry.direction) end
unfolded[vehicle] = blocked
Logging.info(ADFillFold.LOG_PREFIX .. "'%s' foldes ud, så tanken kan fyldes", tostring(ADRuns.vehicleLabel(vehicle)))
elseif action == "fold" then
foldBack(vehicle)
Logging.info(ADFillFold.LOG_PREFIX .. "'%s' foldes sammen efter påfyldning", tostring(ADRuns.vehicleLabel(vehicle)))
end
end
function ADFillFold.tick(adEnv, dt)
if adEnv == nil or ADFieldJobs == nil or ADFieldJobs.state == nil or ADHitch == nil then return end
timerMs = timerMs + (dt or 0)
clockMs = clockMs + (dt or 0)
if timerMs < ADFillFold.TICK_MS then return end
timerMs = 0
local seen = {}
for _, assignment in pairs(ADFieldJobs.state.assignments or {}) do
local vehicle = assignment.vehicle
if vehicle ~= nil and ADFieldWork.REFILL_ROLES[assignment.role] then
seen[vehicle] = true
local ok, err = pcall(tickVehicle, adEnv, vehicle, clockMs)
if not ok then Logging.warning(ADFillFold.LOG_PREFIX .. "%s", tostring(err)) end
end
end
-- genoptagne ture efter indlæsning (ADFieldWork.taken): ingen opgave før ankomst — men de kan holde ved et tomt
-- påfyldningssted (in-game 16/10: kalk-sprederen ved "TMR Silo Farma" efter genstart)
for vehicleId, entry in pairs(ADFieldWork.taken or {}) do
-- kun genoptagne ture (trip), ikke spillerens overtagelser; opslag kun for dem (review: findVehicleById er O(n))
if entry.trip ~= nil and ADFieldWork.REFILL_ROLES[entry.role] and ADFieldJobs.state.assignments[vehicleId] == nil then
local vehicle = ADRunsController.findVehicleById(adEnv, vehicleId)
if vehicle ~= nil and not seen[vehicle] then
seen[vehicle] = true
local ok, err = pcall(tickVehicle, adEnv, vehicle, clockMs)
if not ok then Logging.warning(ADFillFold.LOG_PREFIX .. "%s", tostring(err)) end
end
end
end
-- opgaven sluttede, mens den var foldet ud: fold sammen, hvis CP ikke arbejder
for vehicle in pairs(unfolded) do
if not seen[vehicle] and not (ADCpBridge ~= nil and ADCpBridge.isWorking(vehicle)) then
foldBack(vehicle)
end
end
end