Files
fs25-adsmartpickup/FS25_ADSmartPickup/adHeaderSwap.lua
T

644 lines
33 KiB
Lua

-- AD Header Swap
-- Mejetærsker med skærebord på transporthjul (fx New Holland FD250 med transporthjul): på vejen trækkes skærebordet
-- bag mejetærskeren (trailer-krogen), på marken skal det sidde foran (cutter-krogen). Brugerønske 10/10: mejetærskeren
-- skal selv køre rundt og montere det — ikke "snappe" det på plads.
-- Montér (på marken): kobl af bag -> AD's markstifinder kører mejetærskeren rundt, så fronten står ud for skærebordets
-- cutter-kobling -> kryb frem og kobl på -> fold til arbejdsstilling (transporthjulene væk).
-- Afmontér (efter høst): fold til transport (hjul ned, trækstang ud) -> kobl af foran -> bak fri -> stifinderen stiller
-- bagkrogen ud for trækstangen -> bak ind og kobl på.
-- Hvert trin er en AD-opgave i mejetærskerens kø (samme form som ADHitchCreep's krybning).
-- Konsol (maskinen du sidder i): spuHeaderFront / spuHeaderRear. Ren logik øverst (testes med luajit).
ADHeaderSwap = {}
ADHeaderSwap.LOG_PREFIX = "ADSmartPickup: skærebord: "
-- m før koblingen, stifinderen sigter efter. AD's rute ender ca. 7 m forskudt langs retningen (in-game 10/10 med 12 m:
-- foran 16,9 m fra koblingen, bag kun 5,1 m — for kort til at rette 1,3 m sideforskydning, og mejetærskeren ramte
-- skærebordet). Krybningen klarer højst 18 m.
ADHeaderSwap.APPROACH_FRONT_M = 10
ADHeaderSwap.APPROACH_REAR_M = 18
ADHeaderSwap.SETTLE_MS = 1500 -- skærebordet skal stå stille efter afkoblingen, før stifinderen ser det
ADHeaderSwap.PATH_TIMEOUT_MS = 180000
ADHeaderSwap.ATTACH_TIMEOUT_MS = 4000
ADHeaderSwap.FOLD_TIMEOUT_MS = 30000
ADHeaderSwap.FOLD_DONE_EPS = 0.01
ADHeaderSwap.LIFT_MS = 2000 -- skærebordet hæves, før det foldes til transport
-- Bak fri efter afkobling foran: til der er så meget fri plads mellem mejetærskerens front og skærebordet. AD's rute
-- starter ca. 7 m fremme og drejer, og skærebordet er ~12 m bredt (in-game 10/10: ADHitchCreep's bak-fri stoppede
-- efter 5,5 m, og mejetærskeren svingede ind i skærebordets ende — to gange).
ADHeaderSwap.BACKOFF_CLEAR_M = 15
ADHeaderSwap.BACKOFF_MAX_M = 30
ADHeaderSwap.BACKOFF_TIMEOUT_MS = 40000
ADHeaderSwap.BACKOFF_SPEED = 4 -- km/t
ADHeaderSwap.DETACH_RETRY_MS = 10000
ADHeaderSwap.PARKED_MAX_M = 25 -- et skærebord er kun "parkeret", når det står så tæt på sin P-markør
ADHeaderSwap.APPROACH_RETRIES = 2 -- står den for skævt efter ruten: ny rute så mange gange (in-game 10/10: 3,4 m ved siden af) -- afkobling forsøges igen så længe (spillet: "Detach while folding is not allowed")
-- ---- ren logik ----
function ADHeaderSwap.normalize(x, z)
local length = math.sqrt(x * x + z * z)
if length < 1e-6 then return nil end
return x / length, z / length
end
-- Drej vektoren (vx, vz) samme vinkel, som retningen (fromX, fromZ) skal drejes for at blive (toX, toZ).
-- Vinkler som atan2(x, z) — uafhængigt af motorens akse-konvention.
function ADHeaderSwap.rotate(vx, vz, fromX, fromZ, toX, toZ)
local delta = math.atan2(toX, toZ) - math.atan2(fromX, fromZ)
local c, s = math.cos(delta), math.sin(delta)
return vx * c + vz * s, -vx * s + vz * c
end
-- Startpunktet for den lige indkørsel: approach meter før roden (frem: bagved; bak: foran mejetærskeren).
function ADHeaderSwap.stagePoint(rx, rz, fx, fz, approach, reverse)
local sign = reverse and 1 or -1
return rx + sign * fx * approach, rz + sign * fz * approach
end
-- inputs = {{jointType}, ...} -> indeks på koblingen af typen, ellers nil
function ADHeaderSwap.inputJointIndex(inputs, jointType)
for index, input in ipairs(inputs or {}) do
if input.jointType == jointType then return index end
end
return nil
end
-- Skærebord på transporthjul: både en cutter- og en trailer-kobling.
function ADHeaderSwap.isTransportHeader(inputs, cutterType, trailerType)
return ADHeaderSwap.inputJointIndex(inputs, cutterType) ~= nil and ADHeaderSwap.inputJointIndex(inputs, trailerType) ~= nil
end
-- Foldningens mål: arbejdsstilling = turnOnFoldDirection (FD250: 1 -> animationens slut), transport = modsat.
-- -> retning, mål-tid (0 eller 1)
function ADHeaderSwap.foldTarget(turnOnFoldDirection, toWork)
local work = (turnOnFoldDirection or 1) >= 0 and 1 or -1
local direction = toWork and work or -work
return direction, direction > 0 and 1 or 0
end
-- s = {gap = m fri foran fronten, moved = m bakket, elapsedMs} -> "done" | "drive" | "giveUp"
function ADHeaderSwap.backOffStep(s)
if (s.gap or 0) >= ADHeaderSwap.BACKOFF_CLEAR_M then return "done" end
if (s.moved or 0) >= ADHeaderSwap.BACKOFF_MAX_M or (s.elapsedMs or 0) >= ADHeaderSwap.BACKOFF_TIMEOUT_MS then return "giveUp" end
return "drive"
end
-- s = {animTime, target, elapsedMs, moving} -> "done" | "wait" | "timeout"
-- Færdig først når animationen også står stille (in-game 10/10: 99 % foldet -> "Detach while folding is not allowed").
function ADHeaderSwap.foldStep(s)
if s.animTime ~= nil and math.abs(s.animTime - s.target) <= ADHeaderSwap.FOLD_DONE_EPS and not s.moving then return "done" end
if (s.elapsedMs or 0) >= ADHeaderSwap.FOLD_TIMEOUT_MS then return "timeout" end
return "wait"
end
-- Parkeret skærebord til marken: det nærmeste, der kan høste afgrøden og ikke allerede er taget (taken: to
-- mejetærskere sendt ud i samme omgang). options = {{x, z, fruits = {[fruit] = true}, taken}}
function ADHeaderSwap.pickHeader(options, fruit, x, z)
local best, bestDistance = nil, math.huge
for _, option in ipairs(options or {}) do
if fruit ~= nil and not option.taken and option.fruits ~= nil and option.fruits[fruit] then
local d = (option.x - x) ^ 2 + (option.z - z) ^ 2
if d < bestDistance then best, bestDistance = option, d end
end
end
return best
end
-- ---- spil ----
local active = {}
-- Et skift, hvor AD ikke længere kører (spilleren stoppede, AD opgav), er dødt — så må et nyt startes.
local function liveSwap(combine)
local swap = active[combine]
if swap == nil then return nil end
local stateModule = combine.ad ~= nil and combine.ad.stateModule or nil
if stateModule == nil or not stateModule:isActive() then
active[combine] = nil
return nil
end
return swap
end
local function vehicleName(vehicle)
return vehicle ~= nil and vehicle.getName ~= nil and vehicle:getName() or "?"
end
local function jointTypes()
if AttacherJoints == nil then return nil, nil end
return AttacherJoints.JOINTTYPE_CUTTER, AttacherJoints.JOINTTYPE_TRAILER
end
local function inputsOf(object)
local attachable = object ~= nil and object.spec_attachable or nil
return attachable ~= nil and attachable.inputAttacherJoints or {}
end
local function isTransportHeader(object)
local cutterType, trailerType = jointTypes()
return object ~= nil and object.spec_cutter ~= nil and cutterType ~= nil
and ADHeaderSwap.isTransportHeader(inputsOf(object), cutterType, trailerType)
end
-- Skærebordet på mejetærskeren: header, krogens indeks, foran?
local function attachedHeader(combine)
if combine.getAttachedImplements == nil then return nil end
for _, implement in ipairs(combine:getAttachedImplements()) do
if isTransportHeader(implement.object) then
local joint = combine.spec_attacherJoints.attacherJoints[implement.jointDescIndex]
local node = joint ~= nil and joint.jointTransform or nil
if node ~= nil then
local _, _, z = localToLocal(node, combine.rootNode, 0, 0, 0)
return implement.object, implement.jointDescIndex, z > 0
end
end
end
return nil
end
-- Mejetærskerens krog af typen på den rigtige side (cutter foran, trailer bag).
local function combineJoint(combine, jointType, front)
local spec = combine.spec_attacherJoints
for index, joint in ipairs(spec ~= nil and spec.attacherJoints or {}) do
if joint.jointType == jointType and joint.jointTransform ~= nil then
local _, _, z = localToLocal(joint.jointTransform, combine.rootNode, 0, 0, 0)
if (front and z > 0) or (not front and z < 0) then return index, joint.jointTransform end
end
end
return nil
end
-- Hvor stifinderen skal køre hen: punktet APPROACH_FRONT_M/APPROACH_REAR_M før koblingen, og retningen mejetærskeren skal pege.
-- Retningen: mejetærskerens fremad set fra dens krog, overført til skærebordets kobling (koblingerne flugter, når de
-- sidder sammen). Roden: krogens forskydning fra roden, drejet til den nye retning.
function ADHeaderSwap.approachTarget(combine, combineJointNode, headerInputNode, reverse, headerRootNode)
local root = combine.components[1].node
local cfx, _, cfz = localDirectionToWorld(root, 0, 0, 1)
cfx, cfz = ADHeaderSwap.normalize(cfx, cfz)
local fx, fz
if reverse and headerRootNode ~= nil then
-- trækstangen drejer frit i transportstilling (FD250: op til 75°) og kan hænge skævt efter afkoblingen
-- (in-game 10/10): retningen er skærebordets længdeakse — fra midten ud mod stangens ende
local hx, _, hz = getWorldTranslation(headerRootNode)
local ix, _, iz = getWorldTranslation(headerInputNode)
fx, fz = ADHeaderSwap.normalize(ix - hx, iz - hz)
else
local dx, dy, dz = worldDirectionToLocal(combineJointNode, cfx, 0, cfz)
fx, _, fz = localDirectionToWorld(headerInputNode, dx, dy, dz)
fx, fz = ADHeaderSwap.normalize(fx, fz)
end
if fx == nil or cfx == nil then return nil end
local jx, _, jz = getWorldTranslation(combineJointNode)
local rx, _, rz = getWorldTranslation(root)
local vx, vz = ADHeaderSwap.rotate(jx - rx, jz - rz, cfx, cfz, fx, fz)
local px, _, pz = getWorldTranslation(headerInputNode)
local approach = reverse and ADHeaderSwap.APPROACH_REAR_M or ADHeaderSwap.APPROACH_FRONT_M
local sx, sz = ADHeaderSwap.stagePoint(px - vx, pz - vz, fx, fz, approach, reverse)
return {x = sx, z = sz}, {x = fx, z = fz}
end
-- ---- AD-opgaver ----
local function taskDone(swap)
local taskModule = swap.adEnv.ADTaskModule
swap.combine.ad.taskModule:setCurrentTaskFinished(taskModule ~= nil and taskModule.DONT_PROPAGATE or 1)
end
local function stopDriving(combine)
local sdm = combine.ad ~= nil and combine.ad.specialDrivingModule or nil
if sdm ~= nil and sdm.stopVehicle ~= nil then sdm:stopVehicle() end
end
local function finish(swap, ok, text)
active[swap.combine] = nil
if ok then
Logging.info(ADHeaderSwap.LOG_PREFIX .. "'%s': %s", vehicleName(swap.combine), text)
else
Logging.warning(ADHeaderSwap.LOG_PREFIX .. "'%s': %s — opgivet", vehicleName(swap.combine), text)
local taskModule = swap.combine.ad ~= nil and swap.combine.ad.taskModule or nil
if taskModule ~= nil then pcall(taskModule.abortAllTasks, taskModule) end
end
stopDriving(swap.combine)
if swap.combine.stopAutoDrive ~= nil then pcall(swap.combine.stopAutoDrive, swap.combine) end
if swap.onDone ~= nil then pcall(swap.onDone, swap.combine, ok, text) end
end
local function newTask(swap, info)
local task = {swap = swap, elapsedMs = 0, info = info}
function task:abort() end
function task:finished() end
function task:getInfoText() return self.info end
function task:getI18nInfo() return "" end
function task:getExcludedVehiclesForCollisionCheck() return {self.swap.header} end
return task
end
-- Kobl af bag og vent, til skærebordet er faldet til ro (først når AD kører, så intet efterlades, hvis AD ikke starter).
local function settleTask(swap)
local task = newTask(swap, "Kobler skærebordet af bag")
function task:setUp()
stopDriving(swap.combine)
swap.combine:detachImplementByObject(swap.header)
Logging.info(ADHeaderSwap.LOG_PREFIX .. "'%s' koblede '%s' af bag og kører rundt for at montere det foran", vehicleName(swap.combine), vehicleName(swap.header))
end
function task:update(dt)
self.elapsedMs = self.elapsedMs + dt
stopDriving(swap.combine)
if self.elapsedMs >= ADHeaderSwap.SETTLE_MS then taskDone(swap) end
end
return task
end
-- Kør med AD's markstifinder hen ud for koblingen.
local function pathTask(swap, reverse)
local task = newTask(swap, reverse and "Kører hen foran trækstangen" or "Kører rundt til skærebordet")
function task:setUp()
local cutterType, trailerType = jointTypes()
local jointType = reverse and trailerType or cutterType
local _, jointNode = combineJoint(swap.combine, jointType, not reverse)
local inputIndex = ADHeaderSwap.inputJointIndex(inputsOf(swap.header), jointType)
local input = inputIndex ~= nil and inputsOf(swap.header)[inputIndex] or nil
if jointNode == nil or input == nil or input.node == nil then
return finish(swap, false, reverse and "ingen trailer-krog bag eller trækstang på skærebordet" or "ingen cutter-krog foran eller cutter-kobling på skærebordet")
end
local target, vector = ADHeaderSwap.approachTarget(swap.combine, jointNode, input.node, reverse, swap.header.rootNode)
if target == nil then return finish(swap, false, "kunne ikke regne retningen ud") end
-- AD lægger målpunktet ind som rutens sidste vejpunkt og regner med højden (in-game 10/10: uden y fejlede
-- DrivePathModule:getApproachingHeightDiff i hver frame)
target.y = getTerrainHeightAtWorldPos(g_currentMission.terrainRootNode, target.x, 1, target.z)
self.planning = true
local pathFinder = swap.combine.ad.pathFinderModule
pathFinder:reset()
pathFinder:startPathPlanningTo(target, vector)
local x, _, z = getWorldTranslation(swap.combine.components[1].node)
Logging.info(ADHeaderSwap.LOG_PREFIX .. "'%s' planlægger vej til (%.0f, %.0f), %.0f m væk, %s", vehicleName(swap.combine),
target.x, target.z, math.sqrt((target.x - x) ^ 2 + (target.z - z) ^ 2), reverse and "bagkrogen mod trækstangen" or "fronten mod skærebordet")
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 frem 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 på marken") end
for _, point in ipairs(path) do
if point.y == nil and point.x ~= nil and point.z ~= nil then
point.y = getTerrainHeightAtWorldPos(g_currentMission.terrainRootNode, point.x, 1, point.z)
end
end
Logging.info(ADHeaderSwap.LOG_PREFIX .. "'%s' kører %d vejpunkter", vehicleName(swap.combine), #path)
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
local approachTask
-- Læg opgaver forrest i AD's kø (efter den aktive).
local function enqueueFirst(swap, tasks)
local queue = swap.combine.ad.taskModule.tasks
local rest = {}
while queue:Count() > 0 do table.insert(rest, queue:Dequeue()) end
for _, task in ipairs(tasks) do queue:Enqueue(task) end
for _, task in ipairs(rest) do queue:Enqueue(task) end
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")
function task:setUp()
local target, why = ADHitchCreep.findTarget(swap.combine, front)
if target == nil or target.wagon ~= swap.header then
return finish(swap, false, string.format("fandt ikke skærebordets kobling %s (%s)", front and "foran" or "bag",
target ~= nil and ("nærmest: " .. vehicleName(target.wagon)) or tostring(why)))
end
if target.plan == "none" then
local text = string.format("står skævt: koblingen er %.1f m %s og %.1f m til siden",
math.abs(target.offset.z), target.offset.z >= 0 and "foran" or "bag", target.offset.x)
if (swap.approachRetries or 0) < ADHeaderSwap.APPROACH_RETRIES then
swap.approachRetries = (swap.approachRetries or 0) + 1
Logging.info(ADHeaderSwap.LOG_PREFIX .. "'%s' %s — ny rute (%d/%d)", vehicleName(swap.combine), text,
swap.approachRetries, ADHeaderSwap.APPROACH_RETRIES)
enqueueFirst(swap, {pathTask(swap, not front), approachTask(swap, front)})
return taskDone(swap)
end
return finish(swap, false, text)
end
if target.plan == "attach" then return taskDone(swap) end
self.inner = ADHitchCreep.newCreepTask(swap.adEnv, swap.combine, target)
self.inner:setUp()
end
function task:update(dt)
if self.inner ~= nil then self.inner:update(dt) end
end
return task
end
-- Kobl på (spillets egen kobling inden for rækkevidde) og tjek at det er skærebordet, på den rigtige side.
local function attachTask(swap, front)
local task = newTask(swap, "Kobler skærebordet på")
function task:setUp() stopDriving(swap.combine) end
function task:update(dt)
self.elapsedMs = self.elapsedMs + dt
stopDriving(swap.combine)
local header, _, isFront = attachedHeader(swap.combine)
if header == swap.header and isFront == front then
Logging.info(ADHeaderSwap.LOG_PREFIX .. "'%s' har koblet '%s' på %s", vehicleName(swap.combine), vehicleName(header), front and "foran" or "bag")
return taskDone(swap)
end
if header == nil then
local ok, attached = ADHitch.tryAttach(swap.combine)
if ok and attached ~= swap.header then
-- et andet redskab var nærmere: af igen, og opgiv (ellers kobles der rundt i 4 s)
pcall(swap.combine.detachImplementByObject, swap.combine, attached)
return finish(swap, false, "kom til at koble '" .. vehicleName(attached) .. "' på i stedet for skærebordet")
end
end
if self.elapsedMs >= ADHeaderSwap.ATTACH_TIMEOUT_MS then
return finish(swap, false, "skærebordet kunne ikke kobles på " .. (front and "foran" or "bag"))
end
end
return task
end
-- Fold til arbejdsstilling (transporthjul væk) eller transport (hjul ned, trækstang ud). Hæves og slukkes først.
local function foldTask(swap, toWork)
local task = newTask(swap, toWork and "Folder skærebordet til arbejde" or "Folder skærebordet til transport")
function task:setUp()
local header, jointIndex = swap.header, select(2, attachedHeader(swap.combine))
local foldable = header.spec_foldable
if foldable == nil or header.setFoldDirection == nil then return taskDone(swap) end
if header.getIsTurnedOn ~= nil and header:getIsTurnedOn() and header.setIsTurnedOn ~= nil then header:setIsTurnedOn(false) end
if not toWork and jointIndex ~= nil and swap.combine.setJointMoveDown ~= nil then swap.combine:setJointMoveDown(jointIndex, false) end
self.direction, self.target = ADHeaderSwap.foldTarget(foldable.turnOnFoldDirection, toWork)
-- til transport: vent, til skærebordet er hævet; til arbejde: fold straks
self.waitMs = toWork and 0 or ADHeaderSwap.LIFT_MS
if self.waitMs == 0 then header:setFoldDirection(self.direction) end
end
function task:update(dt)
self.elapsedMs = self.elapsedMs + dt
stopDriving(swap.combine)
if self.waitMs > 0 then
self.waitMs = self.waitMs - dt
if self.waitMs <= 0 then swap.header:setFoldDirection(self.direction) end
self.elapsedMs = 0
return
end
local foldable = swap.header.spec_foldable
local moving = foldable ~= nil and foldable.foldMoveDirection ~= nil and foldable.foldMoveDirection ~= 0
and swap.header.getIsAnimationPlaying ~= nil and foldable.foldingParts ~= nil and foldable.foldingParts[1] ~= nil
and swap.header:getIsAnimationPlaying(foldable.foldingParts[1].animationName) or false
local action = ADHeaderSwap.foldStep({animTime = foldable ~= nil and foldable.foldAnimTime or nil, target = self.target, elapsedMs = self.elapsedMs, moving = moving})
if action == "done" then return taskDone(swap) end
if action == "timeout" then return finish(swap, false, "skærebordet blev ikke foldet " .. (toWork and "til arbejde" or "til transport")) end
end
return task
end
-- Kobl skærebordet af (foran) — det står nu på transporthjulene.
local function detachTask(swap)
local task = newTask(swap, "Kobler skærebordet af")
function task:setUp() stopDriving(swap.combine) end
function task:update(dt)
self.elapsedMs = self.elapsedMs + dt
stopDriving(swap.combine)
if self.detachedAt == nil then
local allowed, warning = true, nil
if swap.header.isDetachAllowed ~= nil then allowed, warning = swap.header:isDetachAllowed() end
if not allowed then
if self.elapsedMs >= ADHeaderSwap.DETACH_RETRY_MS then return finish(swap, false, "må ikke kobles af: " .. tostring(warning)) end
return
end
swap.combine:detachImplementByObject(swap.header)
self.detachedAt = self.elapsedMs
return
end
if self.elapsedMs - self.detachedAt >= ADHeaderSwap.SETTLE_MS then taskDone(swap) end
end
return task
end
-- Bak lige tilbage, til skærebordet står BACKOFF_CLEAR_M foran mejetærskerens front (afstand langs mejetærskeren til
-- skærebordets nærmeste del regnes groft som afstand til roden minus halv skærebordsdybde).
local function backOffTask(swap)
local task = newTask(swap, "Bakker fri af skærebordet")
function task:setUp()
self.start = {getWorldTranslation(swap.combine.rootNode)}
Logging.info(ADHeaderSwap.LOG_PREFIX .. "'%s' bakker fri af '%s' (til %d m fri plads foran)", vehicleName(swap.combine), vehicleName(swap.header), ADHeaderSwap.BACKOFF_CLEAR_M)
end
function task:update(dt)
self.elapsedMs = self.elapsedMs + dt
local combine, autoDrive = swap.combine, swap.adEnv.AutoDrive
local x, _, z = getWorldTranslation(combine.rootNode)
local moved = math.sqrt((x - self.start[1]) ^ 2 + (z - self.start[3]) ^ 2)
local hx, hy, hz = getWorldTranslation(swap.header.rootNode)
local _, _, lz = worldToLocal(combine.rootNode, hx, hy, hz)
local combineHalf = (combine.size ~= nil and combine.size.length or 10) / 2
local headerHalf = (swap.header.size ~= nil and swap.header.size.length or 4) / 2
local gap = lz - combineHalf - headerHalf
local action = ADHeaderSwap.backOffStep({gap = gap, moved = moved, elapsedMs = self.elapsedMs})
if action ~= "drive" then
stopDriving(combine)
if action == "done" then
Logging.info(ADHeaderSwap.LOG_PREFIX .. "'%s' er fri af skærebordet efter %.1f m (%.1f m fri foran)", vehicleName(combine), moved, gap)
else
Logging.warning(ADHeaderSwap.LOG_PREFIX .. "'%s' kom kun %.1f m tilbage (%.1f m fri foran) — kører videre", vehicleName(combine), moved, gap)
end
return taskDone(swap)
end
local sdm = combine.ad.specialDrivingModule
if sdm ~= nil and sdm.releaseVehicle ~= nil then sdm:releaseVehicle() end
local bx, by, bz = localToWorld(combine.rootNode, 0, 0, -20)
local lx, lz2 = autoDrive.getDriveDirection(combine, bx, by, bz)
autoDrive.driveInDirection(combine, dt, 30, 0.3, 0.2, 20, true, false, -lx, -lz2, ADHeaderSwap.BACKOFF_SPEED, 1)
end
return task
end
local function doneTask(swap, text)
local task = newTask(swap, "Færdig")
function task:setUp() finish(swap, true, text) end
function task:update() end
return task
end
-- ---- start ----
local function nearestMarkerId(adEnv, combine)
local x, _, z = getWorldTranslation(combine.components[1].node)
local best, bestDistance = nil, math.huge
for _, marker in pairs(adEnv.ADGraphManager:getMapMarkers() or {}) do
local wp = adEnv.ADGraphManager:getWayPointById(marker.id)
if wp ~= nil then
local d = (wp.x - x) ^ 2 + (wp.z - z) ^ 2
if d < bestDistance then best, bestDistance = marker.id, d end
end
end
return best
end
-- AD startes i "Kør til" (så opgavekøen kører), og dens egen køreopgave byttes ud med skiftets trin.
local function runTasks(adEnv, combine, tasks)
local module = combine.ad.stateModule
if module:isActive() and combine.stopAutoDrive ~= nil then combine:stopAutoDrive() end
local markerId = nearestMarkerId(adEnv, combine)
if markerId == nil then return false, "ingen AutoDrive-markører" end
module:setMode(adEnv.AutoDrive.MODE_DRIVETO)
module:setFirstMarkerByWayPointId(markerId)
if module.setStartHelper ~= nil then module:setStartHelper(false) end
if module.setActualFarmId ~= nil then module:setActualFarmId(combine:getOwnerFarmId()) end
local mode = module:getCurrentMode()
mode:start(adEnv.AutoDrive.USER_PLAYER or 1)
if not module:isActive() then return false, "AutoDrive startede ikke (kører Courseplay?)" end
local taskModule = combine.ad.taskModule
taskModule:abortAllTasks()
mode.driveToDestinationTask = nil
for _, task in ipairs(tasks) do taskModule:addTask(task) end
return true
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)
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
if isFront then return false, "skærebordet sidder allerede foran" end
local cutterType = jointTypes()
if combineJoint(combine, cutterType, true) == nil then return false, "mejetærskeren har ingen cutter-krog foran" end
local allowed, warning = true, nil
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, {
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"),
})
if not ok then return false, why end
active[combine] = swap
return true
end
-- Sæt skærebordet bag på til vejen (efter høst). onDone(combine, ok, tekst).
function ADHeaderSwap.mountRear(adEnv, combine, onDone)
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
if not isFront then return false, "skærebordet sidder allerede bag" end
local _, trailerType = jointTypes()
if combineJoint(combine, trailerType, false) == nil then return false, "mejetærskeren har ingen trailer-krog bag" end
local swap = {adEnv = adEnv, combine = combine, header = header, onDone = onDone}
local ok, why = runTasks(adEnv, combine, {
foldTask(swap, false), detachTask(swap), backOffTask(swap), pathTask(swap, true),
approachTask(swap, false), attachTask(swap, false), doneTask(swap, "skærebordet hænger bag — klar til vejen"),
})
if not ok then return false, why end
active[combine] = swap
Logging.info(ADHeaderSwap.LOG_PREFIX .. "'%s' folder '%s' til transport og sætter det bag på", vehicleName(combine), vehicleName(header))
return true
end
-- Kan mejetærskeren bære et skærebord på transporthjul (cutter-krog foran og trailer-krog bag)?
function ADHeaderSwap.canTowHeader(combine)
if combine == nil or combine.spec_combine == nil or combine.spec_attacherJoints == nil then return false end
local cutterType, trailerType = jointTypes()
return cutterType ~= nil and combineJoint(combine, cutterType, true) ~= nil and combineJoint(combine, trailerType, false) ~= nil
end
-- Frakoblede skærebord på transporthjul med AD-parkering og Connect-markør (som maskinpuljens redskaber), ikke
-- reserveret. -> {{vehicle, id, name, connectId, parkName, fruits, x, z}}
function ADHeaderSwap.parkedHeaders(adEnv, farmId)
local result = {}
if g_currentMission == nil or g_currentMission.vehicleSystem == nil or adEnv == nil then return result end
local graph = adEnv.ADGraphManager
local markers = graph:getMapMarkers()
for _, object in pairs(g_currentMission.vehicleSystem.vehicles or {}) do
if isTransportHeader(object) and object.rootNode ~= nil
and (object.getAttacherVehicle == nil or object:getAttacherVehicle() == nil)
and (farmId == nil or object.getOwnerFarmId == nil or object:getOwnerFarmId() == farmId) then
local index = object.advd ~= nil and object.advd.parkDestination or nil
local park = type(index) == "number" and index >= 1 and graph:getMapMarkerById(index) or nil
local connect = park ~= nil and ADPool ~= nil and ADPool.connectFor(park.name, markers) or nil
local id = ADRunsController ~= nil and ADRunsController.getVehicleId(object) or nil
local x, _, z = getWorldTranslation(object.rootNode)
-- kun ved sin egen parkering: et skærebord der ligger frakoblet midt i et skift ude på marken er ikke ledigt
-- (in-game 10/10: F2 sendte Mejetærsker 1 til P Skærebord 1, mens skærebordet lå på F2)
local parkWp = park ~= nil and graph:getWayPointById(park.id) or nil
local atPark = parkWp ~= nil and (parkWp.x - x) ^ 2 + (parkWp.z - z) ^ 2 <= ADHeaderSwap.PARKED_MAX_M ^ 2
if atPark and connect ~= nil and id ~= nil and not (ADPool.isReserved ~= nil and ADPool.isReserved(id)) then
local okW, width = pcall(ADCpBridge.getWorkWidth, object)
table.insert(result, {vehicle = object, id = id, name = vehicleName(object), connectId = connect.id, parkName = park.name,
fruits = ADCpBridge.harvestFruitSet(object.spec_cutter), x = x, z = z, width = okW and tonumber(width) or nil})
end
end
end
return result
end
-- Afbryd et skift (opgaven er sluppet): AD stoppes, onDone kaldes ikke. -> true hvis der var et.
function ADHeaderSwap.cancel(combine)
local swap = active[combine]
if swap == nil then return false end
active[combine] = nil
swap.onDone = nil
local taskModule = combine.ad ~= nil and combine.ad.taskModule or nil
if taskModule ~= nil then pcall(taskModule.abortAllTasks, taskModule) end
stopDriving(combine)
if combine.stopAutoDrive ~= nil then pcall(combine.stopAutoDrive, combine) end
Logging.info(ADHeaderSwap.LOG_PREFIX .. "'%s': skiftet afbrudt", vehicleName(combine))
return true
end
function ADHeaderSwap.isBusy(combine)
return liveSwap(combine) ~= nil
end
-- Har mejetærskeren et skærebord på transporthjul (bag = "rear", foran = "front"), ellers nil.
function ADHeaderSwap.headerPosition(combine)
local header, _, isFront = attachedHeader(combine)
if header == nil then return nil end
return isFront and "front" or "rear", header
end
-- ---- konsol ----
local function currentVehicle()
return g_localPlayer ~= nil and g_localPlayer.getCurrentVehicle ~= nil and g_localPlayer:getCurrentVehicle() or nil
end
local function consoleRun(name, fn)
local combine = currentVehicle()
if combine == nil or combine.ad == nil then return name .. ": sæt dig i mejetærskeren først" end
local adEnv = ADFieldSilos ~= nil and ADFieldSilos.adEnv or nil
if adEnv == nil then return name .. ": AutoDrive er ikke klar endnu" end
local ok, result, why = pcall(fn, adEnv, combine)
if not ok then return name .. ": fejl: " .. tostring(result) end
if not result then return name .. ": " .. tostring(why) end
return name .. ": " .. vehicleName(combine) .. " er i gang (se loggen)"
end
function ADHeaderSwap:consoleFront()
return consoleRun("spuHeaderFront", ADHeaderSwap.mountFront)
end
function ADHeaderSwap:consoleRear()
return consoleRun("spuHeaderRear", ADHeaderSwap.mountRear)
end
if addConsoleCommand ~= nil then
addConsoleCommand("spuHeaderFront", "Mejetærskeren du sidder i kobler skærebordet af bag og monterer det foran", "consoleFront", ADHeaderSwap)
addConsoleCommand("spuHeaderRear", "Mejetærskeren du sidder i folder skærebordet til transport og sætter det bag på", "consoleRear", ADHeaderSwap)
end