fix: saltrute salter kun i sne og undgår stalde, parkering og ventebaner
This commit is contained in:
@@ -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
|
||||
|
||||
Reference in New Issue
Block a user