145 lines
7.4 KiB
Lua
145 lines
7.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
|
|
|
|
-- 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.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.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
|
|
-- 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
|