feat: krybning følger båsens bakkevej ind til bagredskab ved skæv ankomst (v1.62.85)
This commit is contained in:
@@ -138,6 +138,26 @@ function ADHitchCreep.reverseOutPath(getWp, startId)
|
||||
return path
|
||||
end
|
||||
|
||||
-- Bakkevejen IND i en bås fra dens Connect: følg bakkekanterne (også forbi punkter med forlæns udkørsel), til der ikke
|
||||
-- er flere. Til krybning ind til et bagredskab, når traktoren står skævt (in-game 8/10: efter frontbåsens kurve stod
|
||||
-- T7 3,2 m ved siden af bagklipperens trækøje; bagbåsen har bakkevejen 2104 -> 2105 -> 2106 -> 2107).
|
||||
function ADHitchCreep.reverseChain(getWp, startId)
|
||||
local current = getWp(startId)
|
||||
local path, seen = {}, {[startId] = true}
|
||||
while current ~= nil and #path < ADHitchCreep.REVERSE_OUT_MAX_POINTS do
|
||||
local nextWp = nil
|
||||
for _, id in ipairs(current.out or {}) do
|
||||
local candidate = getWp(id)
|
||||
if not seen[id] and ADHitchCreep.isReverseEdge(current.id, candidate) then nextWp = candidate break end
|
||||
end
|
||||
if nextWp == nil then break end
|
||||
seen[nextWp.id] = true
|
||||
table.insert(path, nextWp.id)
|
||||
current = nextWp
|
||||
end
|
||||
return path
|
||||
end
|
||||
|
||||
-- s = {reached, last, elapsedMs, stillMs} -> "next" | "done" | "drive" | "giveUp"
|
||||
function ADHitchCreep.reverseOutStep(s)
|
||||
if s.reached then return s.last and "done" or "next" end
|
||||
@@ -356,20 +376,34 @@ end
|
||||
local ReverseOutTask = {}
|
||||
ReverseOutTask.__index = ReverseOutTask
|
||||
|
||||
function ReverseOutTask.new(adEnv, vehicle, path)
|
||||
return setmetatable({adEnv = adEnv, vehicle = vehicle, path = path, index = 1, elapsedMs = 0, stillMs = 0}, ReverseOutTask)
|
||||
-- wagon (valgfri): bakkevej ind til et bagredskab — stopper, så snart spillet ser det inden for koblingsrækkevidde.
|
||||
function ReverseOutTask.new(adEnv, vehicle, path, wagon)
|
||||
return setmetatable({adEnv = adEnv, vehicle = vehicle, path = path, wagon = wagon, index = 1, elapsedMs = 0, stillMs = 0,
|
||||
checkMs = 0}, ReverseOutTask)
|
||||
end
|
||||
|
||||
function ReverseOutTask:setUp()
|
||||
self.last = worldPos(self.vehicle.rootNode)
|
||||
Logging.info(ADHitchCreep.LOG_PREFIX .. "'%s' bakker ud af båsen ad %d vejpunkter (%d -> %d)", vehicleName(self.vehicle), #self.path,
|
||||
self.path[1], self.path[#self.path])
|
||||
Logging.info(ADHitchCreep.LOG_PREFIX .. "'%s' bakker %s ad %d vejpunkter (%d -> %d)", vehicleName(self.vehicle),
|
||||
self.wagon ~= nil and ("ind til '" .. vehicleName(self.wagon) .. "'") or "ud af båsen", #self.path, self.path[1], self.path[#self.path])
|
||||
end
|
||||
|
||||
function ReverseOutTask:finish(action)
|
||||
local vehicle = self.vehicle
|
||||
local sdm = vehicle.ad.specialDrivingModule
|
||||
if sdm ~= nil and sdm.stopVehicle ~= nil then sdm:stopVehicle() end
|
||||
if self.wagon ~= nil then
|
||||
if action == "inRange" or action == "done" then
|
||||
Logging.info(ADHitchCreep.LOG_PREFIX .. "'%s' står ved '%s' (bakkevej, vejpunkt %d af %d) — kobler på", vehicleName(vehicle),
|
||||
vehicleName(self.wagon), self.index, #self.path)
|
||||
else
|
||||
Logging.warning(ADHitchCreep.LOG_PREFIX .. "'%s' opgav at bakke ind til '%s' ved vejpunkt %d af %d", vehicleName(vehicle),
|
||||
vehicleName(self.wagon), self.index, #self.path)
|
||||
end
|
||||
local taskModule = self.adEnv.ADTaskModule
|
||||
vehicle.ad.taskModule:setCurrentTaskFinished(taskModule ~= nil and taskModule.DONT_PROPAGATE or 1)
|
||||
return
|
||||
end
|
||||
if action == "done" and self:endsAtDestination() then
|
||||
-- bakkevejen ender ved turens mål (udturen: Connect P Rear Mower = 2104): fremme — AD må ikke køre en omvej
|
||||
-- tilbage til et mål, den nu har bag sig. Køreopgaven fjernes, og AD's "fremme" kører (krybning + stop).
|
||||
@@ -419,6 +453,13 @@ function ReverseOutTask:update(dt)
|
||||
else
|
||||
self.stillMs = self.stillMs + dt
|
||||
end
|
||||
if self.wagon ~= nil then
|
||||
self.checkMs = self.checkMs + dt
|
||||
if self.checkMs >= ADHitchCreep.RANGE_CHECK_MS then
|
||||
self.checkMs = 0
|
||||
if isInRange(vehicle, self.wagon) then return self:finish("inRange") end
|
||||
end
|
||||
end
|
||||
local _, _, lz = worldToLocal(vehicle.rootNode, wp.x, p.y, wp.z)
|
||||
local distance = math.sqrt((p.x - wp.x) ^ 2 + (p.z - wp.z) ^ 2)
|
||||
-- nået: tæt nok på, eller kørt forbi (vejpunktet ligger nu foran traktoren, når den bakker)
|
||||
@@ -512,6 +553,18 @@ function ADHitchCreep.install(adEnv)
|
||||
-- "Connect P Front Mower": frontkrogen og frem; ellers bagkrogen og bak (uændret)
|
||||
local front = ADHitchCreep.isFrontMarker(job.markerName)
|
||||
local target = ADHitchCreep.findTarget(self.vehicle, front)
|
||||
-- skævt i forhold til båsen: følg båsens bakkevej fra Connect ind til redskabet
|
||||
if target ~= nil and not front and target.plan == "none" and target.offset.z < 0 then
|
||||
local graph = adEnv.ADGraphManager
|
||||
local chain = ADHitchCreep.reverseChain(function(id) return graph:getWayPointById(id) end, self.destinationID)
|
||||
local last = chain[#chain] ~= nil and graph:getWayPointById(chain[#chain]) or nil
|
||||
local t = worldPos(target.target)
|
||||
if last ~= nil and (last.x - t.x) ^ 2 + (last.z - t.z) ^ 2 <= ADHitchCreep.CREEP_MAX_DISTANCE ^ 2 then
|
||||
job.crept = true
|
||||
self.vehicle.ad.taskModule:addTask(ReverseOutTask.new(adEnv, self.vehicle, chain, target.wagon))
|
||||
return
|
||||
end
|
||||
end
|
||||
if target == nil or target.plan ~= "creep" then
|
||||
-- hvorfor der ikke bakkes (in-game 6/10: Læssevogn 2 'noAttachable' uden bakning)
|
||||
if target == nil then
|
||||
|
||||
Reference in New Issue
Block a user