-- 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.MOVE_AWAY_M = 20 -- før en ny rute: så langt væk fra skærebordet (ellers er AD's rute "kørt" med det samme) ADHeaderSwap.MOVE_AWAY_TIMEOUT_MS = 30000 ADHeaderSwap.MOVE_AWAY_SPEED = 6 -- km/t 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 -- Skiftet bag på slog fejl: hvad skal der til for at få skærebordet sikkert på foran igen (aldrig efterladt løst på -- marken, in-game 10/10 F14 to gange)? attached = skiftets skærebord sidder på, isFront = foran. -- -> "fold" (sidder foran, fold til arbejde) | "remount" (løst: kør frem og kobl på foran) | nil (sidder bag: intet) function ADHeaderSwap.recoveryPlan(attached, isFront) if attached and isFront then return "fold" end if not attached then return "remount" end return nil 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 startRecovery local function finish(swap, ok, text) if not ok and swap.kind == "rear" and not swap.recovering and startRecovery ~= nil and startRecovery(swap, text) then return end 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 local moveAwayTask -- 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 -- 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 -- ingen vej derind (stor vendediameter med skærebordet på slæb, in-game 10/10): skift her i stedet Logging.info(ADHeaderSwap.LOG_PREFIX .. "'%s': ingen vej ind på marken — skifter skærebord, hvor den holder", vehicleName(swap.combine)) stopDriving(swap.combine) return taskDone(swap) 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 -- Kør lige frem (forward) eller bak lige tilbage MOVE_AWAY_M, så der er plads til en ny indkørsel. moveAwayTask = function(swap, forward) local task = newTask(swap, "Kører fri af skærebordet") function task:setUp() self.start = {getWorldTranslation(swap.combine.rootNode)} 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) if moved >= ADHeaderSwap.MOVE_AWAY_M or self.elapsedMs >= ADHeaderSwap.MOVE_AWAY_TIMEOUT_MS then stopDriving(combine) Logging.info(ADHeaderSwap.LOG_PREFIX .. "'%s' kørte %.1f m %s", vehicleName(combine), moved, forward and "frem" or "tilbage") 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, forward and 20 or -20) local lx, lz = autoDrive.getDriveDirection(combine, bx, by, bz) if forward then autoDrive.driveInDirection(combine, dt, 30, 0.3, 0.2, 20, true, true, lx, lz, ADHeaderSwap.MOVE_AWAY_SPEED, 1) else autoDrive.driveInDirection(combine, dt, 30, 0.3, 0.2, 20, true, false, -lx, -lz, ADHeaderSwap.MOVE_AWAY_SPEED, 1) 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") 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 — kører fri og prøver en ny rute (%d/%d)", vehicleName(swap.combine), text, swap.approachRetries, ADHeaderSwap.APPROACH_RETRIES) -- først væk fra skærebordet: rutens mål lå kun 5 m væk, AD meldte den kørt med det samme, og begge -- forsøg brugte 40 ms uden at mejetærskeren flyttede sig (in-game 10/10) enqueueFirst(swap, {moveAwayTask(swap, not front), 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 -- Skiftet bag på slog fejl: skærebordet på foran igen og foldet ud, så mejetærskeren står som før skiftet. Spilleren -- bedes derefter sætte det bag på (onDone med ok = false). -> true når redningen er startet. startRecovery = function(swap, text) local header, _, isFront = attachedHeader(swap.combine) local plan = ADHeaderSwap.recoveryPlan(header == swap.header, isFront == true) if plan == nil or (header ~= nil and header ~= swap.header) then return false end local taskModule = swap.combine.ad ~= nil and swap.combine.ad.taskModule or nil local stateModule = swap.combine.ad ~= nil and swap.combine.ad.stateModule or nil if taskModule == nil or stateModule == nil or not stateModule:isActive() then return false end swap.recovering, swap.approachRetries = true, 0 local failText = text .. " — skærebordet er sat på foran igen" local tasks = {} if plan == "remount" then -- mejetærskeren står typisk med bagenden mod trækstangen: først rundt med stifinderen, så fronten vender -- mod skærebordet (en kør-fri-bakning ville gå lige ind i det) tasks = {pathTask(swap, false), approachTask(swap, true), attachTask(swap, true)} end table.insert(tasks, foldTask(swap, true)) local last = newTask(swap, "Færdig") function last:setUp() finish(swap, false, failText) end function last:update() end table.insert(tasks, last) Logging.warning(ADHeaderSwap.LOG_PREFIX .. "'%s': %s — sætter skærebordet på foran igen", vehicleName(swap.combine), text) pcall(taskModule.abortAllTasks, taskModule) stopDriving(swap.combine) for _, task in ipairs(tasks) do taskModule:addTask(task) end return true 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, 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 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 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 end ADHeaderSwap.LOOSE_MAX_M = 40 -- løst skærebord så tæt på mejetærskeren kan hentes bag på (spuHeaderRear) -- Nærmeste frakoblede skærebord på transporthjul inden for LOOSE_MAX_M. local function nearestLooseHeader(combine) if g_currentMission == nil or g_currentMission.vehicleSystem == nil then return nil end local cx, _, cz = getWorldTranslation(combine.rootNode) local best, bestDistance = nil, ADHeaderSwap.LOOSE_MAX_M ^ 2 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) then local x, _, z = getWorldTranslation(object.rootNode) local d = (x - cx) ^ 2 + (z - cz) ^ 2 if d < bestDistance then best, bestDistance = object, d end end end return best end -- Sæt skærebordet bag på til vejen (efter høst). onDone(combine, ok, tekst). -- Står skærebordet frakoblet i nærheden (fx efter et opgivet skift, in-game 10/10), køres der rundt og bakkes ind. function ADHeaderSwap.mountRear(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 local loose = nearestLooseHeader(combine) if loose == nil then return false, "intet skærebord med transporthjul koblet på eller i nærheden" end local _, trailerTypeLoose = jointTypes() if combineJoint(combine, trailerTypeLoose, false) == nil then return false, "mejetærskeren har ingen trailer-krog bag" end local swapLoose = {adEnv = adEnv, combine = combine, header = loose, onDone = onDone} local okLoose, whyLoose = runTasks(adEnv, combine, { pathTask(swapLoose, true), approachTask(swapLoose, false), attachTask(swapLoose, false), doneTask(swapLoose, "skærebordet hænger bag — klar til vejen"), }) if not okLoose then return false, whyLoose end active[combine] = swapLoose Logging.info(ADHeaderSwap.LOG_PREFIX .. "'%s' henter det løse '%s' bag på", vehicleName(combine), vehicleName(loose)) return true 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, kind = "rear"} local tasks = { 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"), } -- markarbejdet: skift på den frie plads, hvor skærebordet blev sat på foran (ikke midt i stubben eller ved en -- kant, hvor stifinderen ingen vej finder — in-game 10/10 F14). Foldet til transport først: smallere at køre med. if opts ~= nil and opts.spot ~= nil then table.insert(tasks, 2, driveToSpotTask(swap, opts.spot)) end local ok, why = runTasks(adEnv, combine, tasks) 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