"""依頼234:もの別に埋めた外形どうしで囲まれた床(もののあいだのすき間。どのものの外形にも入らない所)に線が見えるコマを数える(直しはしない・報告用)。 床の線の層は make234.py と同じ描き方(下の部分は make234.py からそのまま写した)。 使い方: python3 between234.py <台本> [閉じる処理の半径 既定 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} 秒)")