tools: tildel parkeringsbåse (P/Connect P) i demobanen
This commit is contained in:
@@ -0,0 +1,87 @@
|
|||||||
|
# Brugerens 17 parkeringsbåse (N_mapMarker) -> "P <navn>" + "Connect P <navn>" (redskaber/vogne), køretøjer ind i båsene.
|
||||||
|
# Mønster fra savegame6: redskab ~4 m fra P mod udgangen, trækstang mod udgangen; Connect 9 m (korte) / 12 m (lange)
|
||||||
|
# ude ad båsen; traktorer forlæns ind med fronten ved P. Kør: python3 assign_parks.py <savegame>
|
||||||
|
import sys, re, math
|
||||||
|
SG = sys.argv[1]
|
||||||
|
ad_path = SG + '/AutoDrive_config.xml'
|
||||||
|
raw = open(ad_path, encoding='utf-8-sig', newline='').read()
|
||||||
|
bom = open(ad_path, 'rb').read(3) == b'\xef\xbb\xbf'
|
||||||
|
nl = '\r\n' if '\r\n' in raw else '\n'
|
||||||
|
wpx = re.search(r'<waypoints>.*?</waypoints>', raw, re.S).group(0)
|
||||||
|
xs = [float(v) for v in re.search(r'<x>(.*?)</x>', wpx, re.S).group(1).split(',')]
|
||||||
|
zs = [float(v) for v in re.search(r'<z>(.*?)</z>', wpx, re.S).group(1).split(',')]
|
||||||
|
mms = re.findall(r'<mm(\d+)>\s*<id>([^<]*)</id>\s*<name>([^<]*)</name>\s*<group>([^<]*)</group>\s*</mm\d+>', raw)
|
||||||
|
markers = [[name, int(float(i)), grp] for _, i, name, grp in mms]
|
||||||
|
bays = sorted([m for m in markers if re.fullmatch(r'\d+_mapMarker', m[0])], key=lambda m: int(m[0].split('_')[0]))
|
||||||
|
assert len(bays) == 17, len(bays)
|
||||||
|
|
||||||
|
# (filnavn-del, nummer blandt ens, navn, connect-afstand i m eller None for traktor)
|
||||||
|
PLAN = [("z18051", 1, "Tipper 1", 12), ("z18051", 2, "Tipper 2", 12), ("mks32", 1, "Milk Tank", 12),
|
||||||
|
("supercis800", 1, "Slurry Tank", 12), ("cenio4000", 1, "Cultivator", 9), ("pov5xl", 1, "Plow", 9),
|
||||||
|
("seeder1500", 1, "Seeder", 9), ("maxima3TIL", 1, "Planter", 9), ("k105", 1, "Spreader", 12),
|
||||||
|
("crystal", 1, "Crystal", None), ("vario700", 1, "Vario 700", None), ("puma", 1, "Puma", None),
|
||||||
|
("multiPurposeTruck", 1, "Pallet Truck", None), ("mt655", 1, "MT655", None), ("series6RLarge", 1, "6R", None),
|
||||||
|
("t7", 1, "T7", None), ("series6C", 1, "6C", None)]
|
||||||
|
|
||||||
|
def bay_waypoint(p_id, metres):
|
||||||
|
"""vejpunkt i båsen 'metres' fra P mod udgangen (båsen løber mod nord, faldende z)"""
|
||||||
|
px, pz = xs[p_id-1], zs[p_id-1]
|
||||||
|
best = None
|
||||||
|
for i in range(p_id, p_id + 12): # båsens vejpunkter følger P-markøren i id-rækkefølge
|
||||||
|
if abs(xs[i-1] - px) > 0.6: continue
|
||||||
|
d = pz - zs[i-1]
|
||||||
|
if best is None or abs(d - metres) < abs(best[1] - metres): best = (i, d)
|
||||||
|
return best
|
||||||
|
|
||||||
|
place = {} # (key,num) -> (cx, cz, yaw, parkIndex)
|
||||||
|
for (key, num, name, conn), bay in zip(PLAN, bays):
|
||||||
|
p_id = bay[1]
|
||||||
|
bay[0] = "P " + name
|
||||||
|
park_index = markers.index(bay) + 1
|
||||||
|
px, pz = xs[p_id-1], zs[p_id-1]
|
||||||
|
if conn:
|
||||||
|
cid, dist = bay_waypoint(p_id, conn)
|
||||||
|
markers.append(["Connect P " + name, cid, "All"])
|
||||||
|
place[(key, num)] = (px, pz - 4.0, 180.0, park_index) # redskab 4 m ude, trækstang mod nord (udgangen)
|
||||||
|
print(f"{name:12s} P wp{p_id} ({px:.1f},{pz:.1f}) Connect wp{cid} {dist:.1f} m ude")
|
||||||
|
else:
|
||||||
|
place[(key, num)] = (px, pz - 2.0, 0.0, park_index) # traktor forlæns ind (mod syd), front ved P
|
||||||
|
print(f"{name:12s} P wp{p_id} ({px:.1f},{pz:.1f})")
|
||||||
|
|
||||||
|
mm = nl + "".join(" <mm%d>%s <id>%d.000000</id>%s <name>%s</name>%s <group>%s</group>%s </mm%d>%s"
|
||||||
|
% (k, nl, wid, nl, name, nl, grp, nl, k, nl) for k, (name, wid, grp) in enumerate(markers, 1)) + " "
|
||||||
|
raw = re.sub(r"(<mapmarker>).*?(</mapmarker>)", lambda m: m.group(1) + mm + m.group(2), raw, count=1, flags=re.S)
|
||||||
|
open(ad_path, 'w', encoding='utf-8-sig' if bom else 'utf-8', newline='').write(raw)
|
||||||
|
|
||||||
|
# køretøjer
|
||||||
|
vpath = SG + '/vehicles.xml'
|
||||||
|
vraw = open(vpath, encoding='utf-8-sig', newline='').read()
|
||||||
|
vbom = open(vpath, 'rb').read(3) == b'\xef\xbb\xbf'
|
||||||
|
def yaw_of(rot):
|
||||||
|
rx, ry, rz = [float(v) for v in rot.split()]
|
||||||
|
return 180.0 - ry if abs(rx) > 90 else ry
|
||||||
|
def move(block, cx, cz, new_yaw):
|
||||||
|
comps = re.findall(r'<component index="(\d+)" position="([^"]*)" rotation="([^"]*)"/>', block)
|
||||||
|
x0, y0, z0 = [float(v) for v in comps[0][1].split()]
|
||||||
|
t0 = math.radians(yaw_of(comps[0][2])); tn = math.radians(new_yaw)
|
||||||
|
def mv(m):
|
||||||
|
px, py, pz = [float(v) for v in m.group(2).split()]
|
||||||
|
dx, dz = px - x0, pz - z0
|
||||||
|
lx = dx*math.cos(t0) - dz*math.sin(t0); lz = dx*math.sin(t0) + dz*math.cos(t0)
|
||||||
|
nx = lx*math.cos(tn) + lz*math.sin(tn); nz = -lx*math.sin(tn) + lz*math.cos(tn)
|
||||||
|
return '<component index="%s" position="%.3f %.3f %.3f" rotation="0.00 %.2f 0.00"/>' % (m.group(1), cx+nx, py, cz+nz, new_yaw)
|
||||||
|
return re.sub(r'<component index="(\d+)" position="([^"]*)" rotation="([^"]*)"/>', mv, block)
|
||||||
|
counts = {}
|
||||||
|
def fix(m):
|
||||||
|
block = m.group(0)
|
||||||
|
key = re.search(r'filename="([^"]*)"', block).group(1).split('/')[-1].replace('.xml', '')
|
||||||
|
counts[key] = counts.get(key, 0) + 1
|
||||||
|
target = place.get((key, counts[key]))
|
||||||
|
if target is None: return block
|
||||||
|
cx, cz, yaw, park = target
|
||||||
|
block = re.sub(r'\s*<AutoDrive [^>]*/>', '', block)
|
||||||
|
block = move(block, cx, cz, yaw)
|
||||||
|
return block.replace('</vehicle>', ' <AutoDrive parkDestination="%d"/>\n </vehicle>' % park)
|
||||||
|
vraw = re.sub(r'<vehicle\s.*?</vehicle>', fix, vraw, flags=re.S)
|
||||||
|
open(vpath, 'w', encoding='utf-8-sig' if vbom else 'utf-8', newline='').write(vraw)
|
||||||
|
print("markører nu:", len(markers), "— køretøjer placeret:", sum(1 for k in place if counts.get(k[0], 0) >= k[1]))
|
||||||
Reference in New Issue
Block a user