"""依頼234：もの別に埋めた外形どうしで囲まれた床（もののあいだのすき間。どのものの外形にも入らない所）に線が見えるコマを数える（直しはしない・報告用）。
床の線の層は make234.py と同じ描き方（下の部分は make234.py からそのまま写した）。
使い方: python3 between234.py <Unity の出力> <台本> [閉じる処理の半径 既定 6]"""
import csv, json, math, os, re, sys
import numpy as np, cv2
from scipy import ndimage
from PIL import Image, ImageChops, ImageDraw, ImageFont
sys.argv = sys.argv[:3] + ["-"] + sys.argv[3:]
FF = "/opt/homebrew/Caskroom/miniforge/base/envs/ros_env/bin/ffmpeg"
D, SC, VD = sys.argv[1:4]; RC = int(sys.argv[4]) if len(sys.argv) > 4 else 6
C = json.load(open(SC))["shots"][0]["c229"]
CAM = json.load(open(os.path.join(D, "top234_cam.json")))
FPS, W, H, S = 30, 1920, 1080, 2          # S：描く倍率（2 倍で描いて縮める）
f0, f1 = int(round(C["video_from"] * FPS)), int(round(C["video_to"] * FPS))
n = f1 - f0 + 1
vt = lambda f: (f - f0) / FPS             # 動画の秒

# ---- 決めた値（1920×1080 の画面での px）
FONT_PATH = "/System/Library/Fonts/ヒラギノ角ゴシック W6.ttc"
HUD_PX, LINE_LABEL_PX, MARK_LABEL_PX = 70, 36, 40
COL = {
    "center": (120, 120, 120),       # 廊下の中心の線（細い実線・灰色）
    "x028": (21, 101, 192),          # 車いすの始めの線 +0.28（破線・青）
    "x042": (142, 36, 170),          # 寄せたあとの線 +0.42（破線・紫）
    "lane": (46, 173, 107),          # ハコブくんのふだんの線 −0.33（破線・ハコブくんの輪の光に近い緑）
    "chair": (239, 108, 0),          # 車いすの通った跡（実線・橙）
    "robot": (0, 105, 92),           # ハコブくんの通った跡（実線・深い青緑）
}
LW = {"center": 3, "dash": 5, "trail": 10, "mark_r": 13, "mark_edge": 3, "leader": 3}
DASH, GAP = 28, 16

# ---- 床の点 → 画面（Unity のカメラで写した 3 点から。正射影なので一次式）
ox, oy = CAM["px_origin"]; xx, xy = CAM["px_per_x"]; zx, zy = CAM["px_per_z"]
def to_px(x, z): return (ox + xx * x + zx * z, oy + xy * x + zy * z)
def from_px(px, py):
    det = xx * zy - zx * xy; dx, dy = px - ox, py - oy
    return ((dx * zy - zx * dy) / det, (xx * dy - dx * xy) / det)   # (x, z)


def font(px): return ImageFont.truetype(FONT_PATH, px * S)
FL, FM, FH = font(LINE_LABEL_PX), font(MARK_LABEL_PX), font(HUD_PX)
def sc(p): return (p[0] * S, p[1] * S)

def text_box(d, xy, s, f, fg, anchor, pad=8, bg=(255, 255, 255, 235), edge=None):
    x, y = xy
    bb = d.textbbox((x, y), s, font=f, anchor=anchor)
    d.rounded_rectangle([bb[0] - pad * S, bb[1] - pad * S, bb[2] + pad * S, bb[3] + pad * S], radius=6 * S, fill=bg, outline=edge, width=2 * S if edge else 0)
    d.text((x, y), s, font=f, fill=fg, anchor=anchor)

def dashed(d, p0, p1, col, w):
    (x0, y0), (x1, y1) = sc(p0), sc(p1)
    L = math.hypot(x1 - x0, y1 - y0); ux, uy = (x1 - x0) / L, (y1 - y0) / L
    s = 0.0
    while s < L:
        e = min(L, s + DASH * S)
        d.line([(x0 + ux * s, y0 + uy * s), (x0 + ux * e, y0 + uy * e)], fill=col, width=w * S)
        s += (DASH + GAP) * S

def down(layer): return layer.resize((W, H), Image.LANCZOS)

# ---- 動かない層：中心の線・目印の線と字
z_lo, z_hi = from_px(0, 0)[1], from_px(W, 0)[1]
LINES = {"center": 0.0, "x028": 0.28, "x042": 0.42, "lane": -0.33}
line_py = {k: to_px(x, z_lo)[1] for k, x in LINES.items()}
st = Image.new("RGBA", (W * S, H * S), (0, 0, 0, 0)); d = ImageDraw.Draw(st)
d.line([sc(to_px(0.0, z_lo)), sc(to_px(0.0, z_hi))], fill=COL["center"] + (255,), width=LW["center"] * S)
for k in ("x028", "x042", "lane"):
    dashed(d, to_px(LINES[k], z_lo), to_px(LINES[k], z_hi), COL[k] + (255,), LW["dash"])
# 字：始め +0.28（線の上）と寄せたあと +0.42（線の下）は左の端（車いすが来るのは右の端なので、入ってくる所と寄せる所を隠さない）、ハコブくんのふだん −0.33 は右の端（ハコブくんが行かない側）
text_box(d, (sc((14, line_py["x028"] - 8))), "始め +0.28", FL, COL["x028"], "lb", edge=COL["x028"])
text_box(d, (sc((14, line_py["x042"] + 8))), "寄せたあと +0.42", FL, COL["x042"], "lt", edge=COL["x042"])
text_box(d, (sc((W - 14, line_py["lane"] - 8))), "ハコブくんのふだん −0.33", FL, COL["lane"], "rb", edge=COL["lane"])
static = down(st)
KER = cv2.getStructuringElement(cv2.MORPH_ELLIPSE, (2 * RC + 1, 2 * RC + 1)); PAD = RC + 24
def filled_obj(soft):
    b = soft > 0
    if not b.any(): return b
    bp = cv2.copyMakeBorder(b.astype(np.uint8), PAD, PAD, PAD, PAD, cv2.BORDER_CONSTANT, value=0)
    cl = cv2.morphologyEx(bp, cv2.MORPH_CLOSE, KER, borderType=cv2.BORDER_CONSTANT, borderValue=0)[PAD:-PAD, PAD:-PAD].astype(bool)
    return ndimage.binary_fill_holes(cl | b)
SA = np.array(static.getchannel("A")) > 0
n_fr, tot, mx, mxf = 0, 0, 0, None
for f in range(f0, f1 + 1):
    ob = np.array(Image.open(f"{D}/frames/yield_top_obj/f_{f:05d}.png").convert("RGB"))
    mk = np.array(Image.open(f"{D}/frames/yield_top_mask/f_{f:05d}.png").convert("L"))
    fl = mk > 0
    for c in range(3): fl |= filled_obj(ob[:, :, c])
    n = int((ndimage.binary_fill_holes(fl) & ~fl & SA).sum())
    if n: n_fr += 1; tot += n
    if n > mx: mx, mxf = n, f
print(f"半径 {RC}：もののあいだで囲まれた床に線が見えるコマ {n_fr}／{f1 - f0 + 1}・画素の合計 {tot}・1 コマの最大 {mx}（コマ {mxf}・動画 {(mxf - f0) / 30 if mxf else 0:.3f} 秒）")
