"""Canonical plan JSON -> SUMO traffic-light programs (build/sumo/plans/.tls.add.xml). Two-phase program per light, matching the model: 1 Big Bend green (through/right 'G', left 'g' = permissive, yields to oncoming) 2 Big Bend yellow 3 all-red 4 cross-street green 5 cross-street yellow 6 all-red Lost time per phase = yellow + all-red (from corridor params). SUMO offset == plan offset_s (verified: phase 1 starts at t = offset). """ import sys, pathlib, json, tomllib sys.path.insert(0, str(pathlib.Path(__file__).parent)) from common import SUMO, ROOT, corridor, tls_map, tls_links import plans as P import nema MOVE = {"s": "T", "r": "R", "R": "R", "l": "L", "L": "L", "t": "L"} def program_nema(tls_id, raw, T, C, g_main, offset, light=None): """County phase sequence scaled to this plan, left arrows sized to measured left-turn demand (see nema.py).""" phases = {int(k): v for k, v in raw["phases"].items()} splits = {int(k): v for k, v in T["splits"].items()} ld = {a: A["q_vph"]*A["turn_share"]["L"] for a, A in light["approaches"].items()} if light else None ivs = nema.build(phases, splits, set(T["main_phases"]), C, g_main+T["clearance_main_s"], left_demand=ld) links = sorted(tls_links(tls_id), key=lambda z: z[0]) merged = [] for d, col in ivs: # fold slivers (< 0.1 s, from ring boundaries a few ms apart) into the previous phase if merged and d < 0.1: merged[-1] = (merged[-1][0]+d, merged[-1][1]) else: merged.append((d, col)) body = [] for d, col in merged: s = "".join(col.get((lab, MOVE.get(dr, "T")), "r") for idx, e_in, e_out, lab, dr in links) body.append(f' ') return f' \n' + "\n".join(body) + "\n " MAIN = ("NB", "SB") def program(tls_id, C, g_main, offset, yellow, allred, yellow_s=None, allred_s=None): links = sorted(tls_links(tls_id), key=lambda z: z[0]) def state(green_main, color): s = [] for idx, e_in, e_out, lab, d in links: ours = (lab in MAIN) == green_main if not ours: s.append("r") elif color == "G": s.append("g" if d in ("l", "L", "t") else "G") else: s.append(color) return "".join(s) yellow_s = yellow if yellow_s is None else yellow_s; allred_s = allred if allred_s is None else allred_s L = yellow+allred+yellow_s+allred_s g_side = C-L-g_main if g_main <= 0 or g_side <= 0: raise ValueError(f"{tls_id}: infeasible greens main={g_main} side={g_side} C={C}") ph = [(g_main, state(True, "G")), (yellow, state(True, "y")), (allred, state(True, "r")), (g_side, state(False, "G")), (yellow_s, state(False, "y")), (allred_s, state(False, "r"))] body = "\n".join(f' ' for d, s in ph) return f' \n{body}\n ' def apply_rtor(xml_body, tls_id): """Right turn on red: right-turn links that would show red show 's' (stop, then proceed when clear).""" links = sorted(tls_links(tls_id), key=lambda z: z[0]) rights = [i for i, (idx, e_in, e_out, lab, dr) in enumerate(links) if dr in ("r", "R")] def fix(m): s = list(m.group(1)) for i in rights: if s[i] == "r": s[i] = "s" return f'state="{"".join(s)}"' import re return re.sub(r'state="([^"]+)"', fix, xml_body) def write(plan): cor = corridor(); tm = tls_map(); pr = cor["params"] scfg = tomllib.load(open(ROOT/"config/corridor.toml", "rb")).get("sumo", {}) mode = scfg.get("signal_program", "two_phase") rawf = ROOT/"data/measured/county_timing.json" raw = json.load(open(rawf)) if rawf.exists() else {} out = [] for l in cor["lights"]: v = plan["lights"][l["id"]] C = v.get("C", plan["C"]) T = l.get("timing") if mode == "nema" and T and l["id"] in raw: out.append(program_nema(tm[l["id"]]["tls"], raw[l["id"]], T, C, v["g_main"], v["offset_s"], light=l)) elif T: # measured yellow / all-red for this light out.append(program(tm[l["id"]]["tls"], C, v["g_main"], v["offset_s"], T["yellow_main_s"], T["all_red_main_s"], T["yellow_side_s"], T["all_red_side_s"])) else: out.append(program(tm[l["id"]]["tls"], C, v["g_main"], v["offset_s"], pr["yellow_s"], pr["all_red_s"])) if scfg.get("right_on_red", False): out = [apply_rtor(x, tm[l["id"]]["tls"]) for x, l in zip(out, cor["lights"])] d = SUMO/"plans"; d.mkdir(parents=True, exist_ok=True) f = d/f"{plan['name']}.tls.add.xml" f.write_text("\n"+"\n".join(out)+"\n\n") return f if __name__ == "__main__": names = sys.argv[1:] or [p.stem for p in P.PLANS.glob("*.json")] for n in names: print("wrote", write(P.load(n)))