676 lines
35 KiB
Lua
676 lines
35 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
|
|
|
|
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)
|
|
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}
|
|
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
|