102 lines
6.6 KiB
Python
102 lines
6.6 KiB
Python
"""savegame8 16/10: nyt FD250-skærebord (transportvogn) i østkolonnens sidste bås ved Farm 102 + Connect til mejetærskeren.
|
|
Skærebordets 6 komponenter drejes som et stift legeme (Giants-rotation R = Rx·Ry·Rz), så trækstangen (komp. 5/6-enden)
|
|
peger ud mod gangen; bagerste ende (komp. 3) 1,0 m fra P. Connect = 1,0 + 15,6 m (målt på det parkerede FD250 ved Farm 130).
|
|
Højder fra nærmeste AD-vejpunkt (pladsen er hævet). Brug: headerbay.py <savegame-mappe> <dem.png> <header-uid-suffix> <bås-mm>
|
|
"""
|
|
import math, re, sys
|
|
import xml.etree.ElementTree as ET
|
|
sys.path.insert(0, "/var/home/masterdraco/fs25-adsmartpickup/tools/ad-smooth")
|
|
from adsmooth import read, write, apply_splits, dist
|
|
from PIL import Image
|
|
|
|
SG = sys.argv[1].rstrip("/") + "/"; im = Image.open(sys.argv[2]); W = im.size[0]; PX = im.load()
|
|
SUF, SLOT = sys.argv[3], int(sys.argv[4])
|
|
NAME = "FD250 Header 2"; GROUP = ".Farm Plot 102 Park"; BACK = 1.0; TO_CONNECT = 15.6
|
|
def ground(x, z):
|
|
cx, cz = x + (W - 1) / 2, z + (W - 1) / 2; i0, j0 = int(cx), int(cz); fx, fz = cx - i0, cz - j0
|
|
p = lambda i, j: PX[min(max(i, 0), W - 1), min(max(j, 0), W - 1)] / 65535 * 255
|
|
return p(i0, j0) * (1 - fx) * (1 - fz) + p(i0 + 1, j0) * fx * (1 - fz) + p(i0, j0 + 1) * (1 - fx) * fz + p(i0 + 1, j0 + 1) * fx * fz
|
|
|
|
def mat(rx, ry, rz):
|
|
a, b, c = (math.radians(t) for t in (rx, ry, rz))
|
|
Rx = [[1, 0, 0], [0, math.cos(a), -math.sin(a)], [0, math.sin(a), math.cos(a)]]
|
|
Ry = [[math.cos(b), 0, math.sin(b)], [0, 1, 0], [-math.sin(b), 0, math.cos(b)]]
|
|
Rz = [[math.cos(c), -math.sin(c), 0], [math.sin(c), math.cos(c), 0], [0, 0, 1]]
|
|
mm = lambda A, B: [[sum(A[i][k] * B[k][j] for k in range(3)) for j in range(3)] for i in range(3)]
|
|
return mm(mm(Rx, Ry), Rz), mm
|
|
def euler(R):
|
|
ry = math.asin(max(-1, min(1, R[0][2])))
|
|
if abs(R[0][2]) < 0.9999999:
|
|
rx = math.atan2(-R[1][2], R[2][2]); rz = math.atan2(-R[0][1], R[0][0])
|
|
else:
|
|
rx = math.atan2(R[2][1], R[1][1]); rz = 0.0
|
|
return tuple(math.degrees(t) for t in (rx, ry, rz))
|
|
# selvtest: euler(mat(...)) giver samme matrix
|
|
for t in ((78.84, 89.27, 101.69), (-22.88, -3.82, 0.71), (120.53, -13.53, 101.36)):
|
|
R, _ = mat(*t); R2, _ = mat(*euler(R)); assert max(abs(R[i][j] - R2[i][j]) for i in range(3) for j in range(3)) < 1e-6, t
|
|
|
|
doc = read(SG + "AutoDrive_config.xml"); N = doc["N"]
|
|
# terrænet ved parkeringspladsen er hævet af spilleren (savegame) — kortets dem.png er 8 m for lavt dér (in-game 16/10):
|
|
# højden tages fra nærmeste AD-vejpunkt (bakkesporet), ligesom farm102park.py
|
|
def ground(x, z):
|
|
return min(N.values(), key=lambda n: (n["x"] - x) ** 2 + (n["z"] - z) ** 2)["y"]
|
|
MK_RE = r"<mm(\d+)>\s*<id>([\d.]+)</id>\s*<name>([^<]*)</name>\s*<group>([^<]*)</group>"
|
|
mk = {int(m.group(1)): dict(wp=int(float(m.group(2))), name=m.group(3), group=m.group(4)) for m in re.finditer(MK_RE, doc["s"])}
|
|
assert re.fullmatch(r"P Ledig \d+", mk[SLOT]["name"]) and mk[SLOT]["group"] == GROUP, mk[SLOT]
|
|
assert not any(m["name"] == "P " + NAME for m in mk.values())
|
|
pw = mk[SLOT]["wp"]; P = N[pw]
|
|
def bay_axis(p_wp):
|
|
cur, prev = p_wp, None
|
|
for _ in range(6):
|
|
nb = [x for x in set(N[cur]["out"]) | set(N[cur]["inc"]) if x != prev]
|
|
if not nb: break
|
|
nxt = max(nb, key=lambda x: dist(N[x], P)); prev, cur = cur, nxt
|
|
return math.atan2(N[cur]["x"] - P["x"], N[cur]["z"] - P["z"])
|
|
e = bay_axis(pw); ux, uz = math.sin(e), math.cos(e) # retning fra P ud mod gangen
|
|
|
|
VT = ET.parse(SG + "vehicles.xml"); VR = VT.getroot()
|
|
v = [x for x in VR.iter("vehicle") if x.get("uniqueId", "").endswith(SUF)]; assert len(v) == 1; v = v[0]
|
|
cs = v.findall("component"); assert len(cs) == 6
|
|
pos = [[float(t) for t in c.get("position").split()] for c in cs]; rot = [[float(t) for t in c.get("rotation").split()] for c in cs]
|
|
# trækstangsretning nu: fra komp. 3 (bagende) mod komp. 6 (trækstang); skal pege ud mod gangen (ux, uz)
|
|
bx, bz = pos[5][0] - pos[2][0], pos[5][2] - pos[2][2]
|
|
d = math.atan2(ux, uz) - math.atan2(bx, bz) # drejning om Y (vinkel målt som atan2(x, z))
|
|
Ry, mm = mat(0, math.degrees(d), 0)
|
|
dealer_ground = min(q[1] for q in pos) - 0.4 # forhandlerens plads: laveste komponent ~0,4 m over jorden
|
|
anchor = pos[2]; tx, tz = P["x"] + BACK * ux, P["z"] + BACK * uz
|
|
for c, p, r in zip(cs, pos, rot):
|
|
rxo, rzo = p[0] - anchor[0], p[2] - anchor[2]
|
|
nx = tx + rxo * math.cos(d) + rzo * math.sin(d); nz = tz - rxo * math.sin(d) + rzo * math.cos(d)
|
|
off = p[1] - dealer_ground
|
|
c.set("position", "%.3f %.3f %.3f" % (nx, ground(nx, nz) + off, nz))
|
|
R, _ = mat(*r); c.set("rotation", "%.2f %.2f %.2f" % euler(mm(Ry, R)))
|
|
newp = [[float(t) for t in c.get("position").split()] for c in cs]
|
|
print("trækstang efter drejning: (%.2f, %.2f) skal være (%.2f, %.2f)" % (
|
|
(newp[5][0] - newp[2][0]) / 11.9, (newp[5][2] - newp[2][2]) / 11.9, ux, uz))
|
|
ad = v.find("AutoDrive")
|
|
if ad is None:
|
|
last = list(v)[-1]; ad = ET.SubElement(v, "AutoDrive"); ad.tail = last.tail; last.tail = "\n "
|
|
ad.set("parkDestination", str(SLOT))
|
|
|
|
# Connect på bakkesporet BACK + TO_CONNECT fra P
|
|
def along_lat(x, z):
|
|
dx, dz = x - P["x"], z - P["z"]; return dx * ux + dz * uz, dx * uz - dz * ux
|
|
dd = BACK + TO_CONNECT; track = sorted((a, i) for i, n in N.items() for a, l in [along_lat(n["x"], n["z"])] if abs(l) < 0.35 and -0.1 < a < 30)
|
|
for (a1, i1), (a2, i2) in zip(track, track[1:]):
|
|
if (i2 in N[i1]["out"] or i1 in N[i2]["out"]) and a1 <= dd <= a2:
|
|
u, w = min(i1, i2), max(i1, i2); du = round(abs(dd - (a1 if u == i1 else a2)), 3); break
|
|
else:
|
|
raise SystemExit("fandt ikke sporet %.1f m fra P" % dd)
|
|
made = apply_splits(N, {(u, w): {du}})
|
|
write(doc, SG + "AutoDrive_config.xml.new")
|
|
raw = open(SG + "AutoDrive_config.xml.new", "rb").read(); bom = raw.startswith(b"\xef\xbb\xbf"); s = raw.decode("utf-8-sig")
|
|
s, n = re.subn(r"(<mm%d>\s*<id>[\d.]+</id>\s*<name>)[^<]*(</name>)" % SLOT, lambda m: m.group(1) + "P " + NAME + m.group(2), s); assert n == 1
|
|
nxt = max(mk) + 1
|
|
add = (" <mm%d>\r\n <id>%d.000000</id>\r\n <name>Connect P %s</name>\r\n"
|
|
" <group>%s</group>\r\n </mm%d>\r\n") % (nxt, made[(u, w, du)], NAME, GROUP, nxt)
|
|
i = s.rfind(" </mapmarker>"); s = s[:i] + add + s[i:]
|
|
open(SG + "AutoDrive_config.xml.new", "wb").write((b"\xef\xbb\xbf" if bom else b"") + s.encode("utf-8"))
|
|
body = ET.tostring(VR, encoding="unicode").replace("\r\n", "\n").replace("\n", "\r\n")
|
|
open(SG + "vehicles.xml.new", "wb").write(b"\xef\xbb\xbf" + ('<?xml version="1.0" encoding="utf-8" standalone="no"?>\r\n' + body + "\r\n").encode("utf-8"))
|
|
print("mm%d -> 'P %s', Connect mm%d %.1f m fra P; skærebord drejet %.0f°; skrevet .new" % (SLOT, NAME, nxt, dd, math.degrees(d)))
|