feat: skærebordsskift 45 m inde på marken, ikke ved markøren — 1.62.192
This commit is contained in:
@@ -88,6 +88,27 @@ function ADFieldJobs.coursePoint(points, x, z, fruit)
|
||||
return ADFieldJobs.nearestPoint(points, x, z)
|
||||
end
|
||||
|
||||
-- Sted at skifte skærebord: inset meter ind på marken fra markkanten nærmest (x, z), mod (cx, cz) — væk fra indkørslen,
|
||||
-- vejen og træerne (in-game 10/10 F5). -> {x, z, dirX, dirZ} (retning ind mod marken) eller nil uden omrids.
|
||||
function ADFieldJobs.swapSpot(verts, x, z, cx, cz, inset)
|
||||
if verts == nil or #verts < 3 or cx == nil then return nil end
|
||||
local bestX, bestZ, bestD = nil, nil, math.huge
|
||||
for index = 1, #verts do
|
||||
local a, b = verts[index], verts[index % #verts + 1]
|
||||
local dx, dz = b.x - a.x, b.z - a.z
|
||||
local len2 = dx * dx + dz * dz
|
||||
local t = len2 > 0 and math.max(0, math.min(1, ((x - a.x) * dx + (z - a.z) * dz) / len2)) or 0
|
||||
local px, pz = a.x + t * dx, a.z + t * dz
|
||||
local d = (px - x) ^ 2 + (pz - z) ^ 2
|
||||
if d < bestD then bestX, bestZ, bestD = px, pz, d end
|
||||
end
|
||||
local vx, vz = cx - bestX, cz - bestZ
|
||||
local len = math.sqrt(vx * vx + vz * vz)
|
||||
if len < 1e-6 then return nil end
|
||||
local step = math.min(inset or 45, len)
|
||||
return {x = bestX + vx / len * step, z = bestZ + vz / len * step, dirX = vx / len, dirZ = vz / len}
|
||||
end
|
||||
|
||||
-- Kursets startpunkt inde på marken: står maskinen uden for marken (fx ved F-markøren ude ved vejen), lægger Courseplay
|
||||
-- ellers kursets start uden for marken og kører ad vejen (in-game 10/10 F14). -> punktet på markkanten nærmest (x, z),
|
||||
-- flyttet inset meter ind mod (cx, cz). Står maskinen allerede på marken: (x, z).
|
||||
|
||||
@@ -16,7 +16,8 @@ ADFieldWork.PLAYER_DRIVING_MS = 3000 -- så længe skal spilleren køre selv,
|
||||
ADFieldWork.WINDROW_MEASURE_MS = 10000
|
||||
-- mangler der sæt, prøves igen efter så lang tid (ikke hvert sekund over hele flåden)
|
||||
ADFieldWork.NO_RIG_RETRY_MS = 30000
|
||||
ADFieldWork.COURSE_FAIL_RETRY_MS = 1800000 -- Courseplay kunne ikke lave kursus/finde markgrænsen: prøv igen om 30 min
|
||||
ADFieldWork.COURSE_FAIL_RETRY_MS = 1800000
|
||||
ADFieldWork.SWAP_INSET_M = 45 -- skærebordet skiftes så langt inde på marken, væk fra indkørslen (in-game 10/10 F5) -- Courseplay kunne ikke lave kursus/finde markgrænsen: prøv igen om 30 min
|
||||
-- AutoDrive der stopper før markøren startes igen så mange gange, før turen opgives
|
||||
ADFieldWork.DRIVE_RETRIES = 2
|
||||
-- længere fra AD-vejnettet end dette kan AutoDrive ikke finde en rute ("Could not calculate path", in-game 26/9:
|
||||
@@ -1767,9 +1768,19 @@ function ADFieldWork.startHeaderSwap(adEnv, assignment, toward)
|
||||
if (toward == "front" and position ~= "rear") or (toward == "rear" and position ~= "front") then return "none" end
|
||||
local swap = {done = false}
|
||||
local mount = toward == "front" and ADHeaderSwap.mountFront or ADHeaderSwap.mountRear
|
||||
-- montering foran: først ADFieldWork.SWAP_INSET_M ind på marken, mod afgrøden/midten
|
||||
local mountOpts = nil
|
||||
if toward == "front" then
|
||||
local info = ADFields.getInfo(assignment.fieldId)
|
||||
if info ~= nil then
|
||||
local vx, vz = vehiclePosition(assignment.vehicle)
|
||||
local target = ADFieldJobs.coursePoint(info.points, vx, vz, info.fruitIndex) or {x = info.x, z = info.z}
|
||||
mountOpts = {spot = ADFieldJobs.swapSpot(info.verts, vx, vz, target.x, target.z, ADFieldWork.SWAP_INSET_M)}
|
||||
end
|
||||
end
|
||||
local ok, started, why = pcall(mount, adEnv, assignment.vehicle, function(_, okSwap, text)
|
||||
swap.done, swap.ok, swap.text = true, okSwap, text
|
||||
end)
|
||||
end, mountOpts)
|
||||
if not ok or not started then
|
||||
log(assignment.fieldId, "'%s': skærebordet kunne ikke %s (%s)", ADRuns.vehicleLabel(assignment.vehicle),
|
||||
toward == "front" and "monteres foran" or "sættes bag på", tostring(ok and why or started))
|
||||
|
||||
@@ -316,6 +316,46 @@ local function enqueueFirst(swap, tasks)
|
||||
for _, task in ipairs(rest) do queue:Enqueue(task) end
|
||||
end
|
||||
|
||||
-- Kør (med skærebordet på slæb) hen til et sted med plads, før der skiftes: spot = {x, z, dirX, dirZ}. In-game 10/10
|
||||
-- F5: ved markøren i et vejkryds fandt stifinderen ingen plads på marken og kørte ind mellem træerne.
|
||||
local function driveToSpotTask(swap, spot)
|
||||
local task = newTask(swap, "Kører ind på marken for at skifte skærebord")
|
||||
function task:setUp()
|
||||
local y = getTerrainHeightAtWorldPos(g_currentMission.terrainRootNode, spot.x, 1, spot.z)
|
||||
self.planning = true
|
||||
local pathFinder = swap.combine.ad.pathFinderModule
|
||||
pathFinder:reset()
|
||||
pathFinder:startPathPlanningTo({x = spot.x, y = y, z = spot.z}, {x = spot.dirX, z = spot.dirZ})
|
||||
Logging.info(ADHeaderSwap.LOG_PREFIX .. "'%s' kører ind på marken (%.0f, %.0f) for at skifte skærebord", vehicleName(swap.combine), spot.x, spot.z)
|
||||
end
|
||||
function task:update(dt)
|
||||
self.elapsedMs = self.elapsedMs + dt
|
||||
if self.elapsedMs >= ADHeaderSwap.PATH_TIMEOUT_MS then return finish(swap, false, "nåede ikke ind på marken på 3 min") end
|
||||
local ad = swap.combine.ad
|
||||
if self.planning then
|
||||
if ad.pathFinderModule:hasFinished() then
|
||||
local path = ad.pathFinderModule:getPath()
|
||||
if path == nil or #path == 0 then return finish(swap, false, "AD's stifinder fandt ingen vej ind på marken") end
|
||||
for _, point in ipairs(path) do
|
||||
if point.y == nil and point.x ~= nil then point.y = getTerrainHeightAtWorldPos(g_currentMission.terrainRootNode, point.x, 1, point.z) end
|
||||
end
|
||||
ad.drivePathModule:setWayPoints(path)
|
||||
self.planning = false
|
||||
else
|
||||
ad.pathFinderModule:update(dt)
|
||||
ad.specialDrivingModule:stopVehicle()
|
||||
ad.specialDrivingModule:update(dt)
|
||||
end
|
||||
elseif ad.drivePathModule:isTargetReached() then
|
||||
stopDriving(swap.combine)
|
||||
taskDone(swap)
|
||||
else
|
||||
ad.drivePathModule:update(dt)
|
||||
end
|
||||
end
|
||||
return task
|
||||
end
|
||||
|
||||
-- Det sidste stykke: ADHitchCreep's krybning (frem til frontkrogen / bak til bagkrogen).
|
||||
approachTask = function(swap, front)
|
||||
local task = newTask(swap, front and "Kører frem til skærebordet" or "Bakker til trækstangen")
|
||||
@@ -511,7 +551,7 @@ local function runTasks(adEnv, combine, tasks)
|
||||
end
|
||||
|
||||
-- Montér skærebordet foran (mejetærskeren står på marken med skærebordet bag sig). onDone(combine, ok, tekst).
|
||||
function ADHeaderSwap.mountFront(adEnv, combine, onDone)
|
||||
function ADHeaderSwap.mountFront(adEnv, combine, onDone, opts)
|
||||
if liveSwap(combine) ~= nil then return false, "skifter allerede skærebord" end
|
||||
local header, _, isFront = attachedHeader(combine)
|
||||
if header == nil then return false, "intet skærebord med transporthjul koblet på" end
|
||||
@@ -522,10 +562,13 @@ function ADHeaderSwap.mountFront(adEnv, combine, onDone)
|
||||
if header.isDetachAllowed ~= nil then allowed, warning = header:isDetachAllowed() end
|
||||
if not allowed then return false, "skærebordet må ikke kobles af: " .. tostring(warning) end
|
||||
local swap = {adEnv = adEnv, combine = combine, header = header, onDone = onDone}
|
||||
local ok, why = runTasks(adEnv, combine, {
|
||||
local tasks = {
|
||||
settleTask(swap), pathTask(swap, false), approachTask(swap, true), attachTask(swap, true), foldTask(swap, true),
|
||||
doneTask(swap, "skærebordet sidder foran og er foldet ud — klar til høst"),
|
||||
})
|
||||
}
|
||||
-- markarbejdet: først ind på marken, væk fra indkørslen (opts.spot)
|
||||
if opts ~= nil and opts.spot ~= nil then table.insert(tasks, 1, driveToSpotTask(swap, opts.spot)) end
|
||||
local ok, why = runTasks(adEnv, combine, tasks)
|
||||
if not ok then return false, why end
|
||||
active[combine] = swap
|
||||
return true
|
||||
|
||||
@@ -1,7 +1,7 @@
|
||||
<?xml version="1.0" encoding="utf-8" standalone="no"?>
|
||||
<modDesc descVersion="107">
|
||||
<author>masterdraco</author>
|
||||
<version>1.62.191.0</version>
|
||||
<version>1.62.192.0</version>
|
||||
<title>
|
||||
<en>AD Smart Pickup</en>
|
||||
</title>
|
||||
|
||||
Reference in New Issue
Block a user