-- 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 ADHeaderSwap.DETACH_RETRY_MS = 10000 -- 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 = {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 -- ---- 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) local root = combine.components[1].node local cfx, _, cfz = localDirectionToWorld(root, 0, 0, 1) cfx, cfz = ADHeaderSwap.normalize(cfx, cfz) local dx, dy, dz = worldDirectionToLocal(combineJointNode, cfx, 0, cfz) local fx, _, fz = localDirectionToWorld(headerInputNode, dx, dy, dz) fx, fz = ADHeaderSwap.normalize(fx, fz) 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) 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 -- Det sidste stykke: ADHitchCreep's krybning (frem til frontkrogen / bak til bagkrogen). local function approachTask(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 return finish(swap, false, 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)) 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 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), ADHitchCreep.newBackOffTask(adEnv, combine, header), 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 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