fix: saltrute salter kun i sne og undgår stalde, parkering og ventebaner

This commit is contained in:
2026-10-21 01:33:22 +02:00
parent 0fc7337242
commit f54e853f67
3 changed files with 100 additions and 8 deletions
+98 -7
View File
@@ -18,6 +18,16 @@ ADSaltRoute.SPACING_M = 25 -- markører tættere end dette på en
ADSaltRoute.ARRIVE_M = 25 -- fremme ved markøren
ADSaltRoute.CHECK_MS = 60 * 1000 -- så ofte undersøges det, om der skal saltes
ADSaltRoute.STEP_MS = 1000 -- så ofte følges det kørende job
-- sprederen kun tændt, hvor der ligger sne (brugerønske 21/10 01:28: den saltede foderbordet inde i kostalden).
-- Målefeltet ligger om traktoren, der kører foran sprederen; efter sidste sne bliver den tændt lidt endnu, så
-- sprederen bag traktoren når det sidste stykke med
ADSaltRoute.GROUND_SNOW_M = 0.01 -- sne på jorden (m) der tæller
ADSaltRoute.SNOW_PROBE_M = 3 -- halv side af målefeltet om traktoren (6 x 6 m)
-- parkering/venteplads (brugerønske 21/10 01:30: "den skal heller ikke køre ind på baner hvor der holder køretøjer,
-- wait og parkering, da den så bare kommer til at holde fast der")
ADSaltRoute.SERVICE_CLEAR_M = 15 -- rutepunkt så tæt på en P-/Connect-/Wait-markør springes over
ADSaltRoute.OCCUPIED_M = 12 -- rutepunkt med et andet køretøj så tæt på springes over
ADSaltRoute.SPREAD_HOLD_MS = 1500 -- tændt så længe efter sidste sne under traktoren (sprederen sidder ~1 s bag den)
ADSaltRoute.LEG_TIMEOUT_MS = 10 * 60 * 1000
ADSaltRoute.REFILL_TIMEOUT_MS = 15 * 60 * 1000
ADSaltRoute.START_GRACE_MS = 10 * 1000
@@ -182,6 +192,54 @@ local function setSpreader(spreader, on)
pcall(spreader.setIsTurnedOn, spreader, on)
end
-- Ren: ligger (x, z) inden for radius af et af punkterne {{x, z}}?
function ADSaltRoute.isNear(x, z, points, radius)
if x == nil or z == nil then return false end
local r2 = radius * radius
for _, point in ipairs(points or {}) do
local dx, dz = point.x - x, point.z - z
if dx * dx + dz * dz <= r2 then return true end
end
return false
end
-- Ren: skal sprederen være tændt? groundSnow = sne under traktoren nu, lastSnowAt = sidste gang der var sne
function ADSaltRoute.shouldSpread(groundSnow, nowMs, lastSnowAt, holdMs)
if groundSnow then return true end
return lastSnowAt ~= nil and nowMs - lastSnowAt < (holdMs or ADSaltRoute.SPREAD_HOLD_MS)
end
-- Ligger der sne om punktet? -> true/false, nil = ukendt (intet snesystem/position)
local function snowAtPoint(x, z)
local snow = g_currentMission ~= nil and g_currentMission.snowSystem or nil
if snow == nil or snow.getSnowHeightAtArea == nil or x == nil or z == nil then return nil end
local r = ADSaltRoute.SNOW_PROBE_M
local ok, height = pcall(snow.getSnowHeightAtArea, snow, x - r, z - r, x + r, z - r, x - r, z + r)
if not ok or type(height) ~= "number" then return nil end
return height > ADSaltRoute.GROUND_SNOW_M
end
local function groundSnowAt(vehicle)
local x, z = position(vehicle)
return snowAtPoint(x, z)
end
-- Rutepunkt uden sne (inde i en stald, under tag, allerede saltet) køres der ikke til (brugerønske 21/10 01:29:
-- "2 gange igennem staldene" — foder-markørerne står på foderbordet)
local function pointHasSnow(adEnv, markerId)
local wp = adEnv.ADGraphManager:getWayPointById(markerId)
if wp == nil then return true end
return snowAtPoint(wp.x, wp.z) ~= false
end
-- Sprederen tændt, hvor der er sne (ukendt sne: tændt som før)
local function spreadWhereSnow(current)
local snow = groundSnowAt(current.driver)
if snow == nil then setSpreader(current.spreader, true) return end
if snow then current.lastSnowAt = now() end
setSpreader(current.spreader, ADSaltRoute.shouldSpread(snow, now(), current.lastSnowAt, ADSaltRoute.SPREAD_HOLD_MS))
end
-- Kan traktoren/den selvkørende spreder bruges nu? (samme optaget-regler som dyreturene)
local function driverFree(vehicle)
if vehicle == nil or vehicle.ad == nil or busyVehicles[vehicle] ~= nil then return false end
@@ -256,15 +314,23 @@ end
-- Rutens punkter: gruppe 1 = gårdens bygningers markører, gruppe 2 = flowenes kilder, mål, lagre og fodringsbygninger
local function routePoints(adEnv, farmId)
local graph = adEnv.ADGraphManager
local candidate = {}
local candidate, service = {}, {}
for _, marker in pairs(graph:getMapMarkers()) do
if ADBuildings == nil or ADBuildings.isCandidateMarker(marker) then candidate[marker.id] = true end
if ADBuildings == nil or ADBuildings.isCandidateMarker(marker) then
candidate[marker.id] = true
else
local wayPoint = graph:getWayPointById(marker.id)
if wayPoint ~= nil then table.insert(service, {x = wayPoint.x, z = wayPoint.z}) end
end
end
local points = {}
local function add(id, phase)
if id == nil or not candidate[id] then return end
local wayPoint = graph:getWayPointById(id)
if wayPoint ~= nil then table.insert(points, {id = id, x = wayPoint.x, z = wayPoint.z, phase = phase}) end
-- ved parkering/ventepladser: ikke et mål (der holder maskiner)
if wayPoint ~= nil and not ADSaltRoute.isNear(wayPoint.x, wayPoint.z, service, ADSaltRoute.SERVICE_CLEAR_M) then
table.insert(points, {id = id, x = wayPoint.x, z = wayPoint.z, phase = phase})
end
end
local function addBuilding(building, phase)
if building == nil then return end
@@ -335,12 +401,33 @@ local function fail(adEnv, text)
goHome(adEnv, text, true)
end
-- Holder der et andet køretøj ved punktet? (saltrutens egne maskiner tæller ikke)
local function occupied(adEnv, markerId)
local wp = adEnv.ADGraphManager:getWayPointById(markerId)
if wp == nil then return false end
local positions = {}
for _, vehicle in pairs(g_currentMission.vehicleSystem.vehicles or {}) do
if vehicle ~= job.driver and vehicle ~= job.spreader and vehicle.spec_motorized ~= nil then
local x, z = position(vehicle)
if x ~= nil then table.insert(positions, {x = x, z = z}) end
end
end
return ADSaltRoute.isNear(wp.x, wp.z, positions, ADSaltRoute.OCCUPIED_M)
end
-- Næste rutepunkt der kan nås; ingen flere = ruten er færdig
local function nextLeg(adEnv)
while job.index <= #job.route do
local point = job.route[job.index]
if ADWaitPool == nil or ADWaitPool.hasRouteTo(adEnv, job.driver, point.id) then
setSpreader(job.spreader, true)
local busyNow = occupied(adEnv, point.id)
-- holder der en maskine (måske kun forbi): prøv punktet igen én gang til sidst i ruten (review)
if busyNow and not point.retried then table.insert(job.route, {id = point.id, x = point.x, z = point.z, phase = point.phase, retried = true}) end
if pointHasSnow(adEnv, point.id) and not busyNow
and (ADWaitPool == nil or ADWaitPool.hasRouteTo(adEnv, job.driver, point.id)) then
local graph = adEnv.ADGraphManager
local marker = graph.getMapMarkerByWayPointId ~= nil and graph:getMapMarkerByWayPointId(point.id) or nil
logInfo(ADSaltRoute.LOG_PREFIX .. "'%s' salter mod '%s' (%d/%d)", vname(job.driver), tostring(marker ~= nil and marker.name or point.id), job.index, #job.route)
spreadWhereSnow(job)
job.phase, job.since, job.markerId, job.restarted = "route", now(), point.id, false
ADFieldWork.startAd(adEnv, job.driver, adEnv.AutoDrive.MODE_DRIVETO, point.id, nil)
return
@@ -348,7 +435,11 @@ local function nextLeg(adEnv)
job.index = job.index + 1
end
ADSaltRoute.lastDone = {height = snowHeight(), day = currentDay()}
goHome(adEnv, string.format("saltruten er færdig (%d af %d steder nået) — '%s' kører hjem", job.visited or 0, #job.route, vname(job.driver)))
local retries = 0
for _, point in ipairs(job.route) do if point.retried then retries = retries + 1 end end
local skipped = #job.route - retries - (job.visited or 0)
goHome(adEnv, string.format("saltruten er færdig (%d steder saltet%s) — '%s' kører hjem", job.visited or 0,
skipped > 0 and string.format(", %d sprunget over: ingen sne, optaget eller ingen vej", skipped) or "", vname(job.driver)))
end
local function refill(adEnv)
@@ -433,7 +524,7 @@ local function stepJob(adEnv)
if job.phase == "route" then
if level <= 0 then refill(adEnv) return end -- løbet tør undervejs: fyld, og fortsæt fra samme punkt
if driving then
setSpreader(job.spreader, true)
spreadWhereSnow(job)
if now() - job.since > ADSaltRoute.LEG_TIMEOUT_MS then
pcall(job.driver.stopAutoDrive, job.driver)
job.index = job.index + 1 -- springes over; næste punkt