"""依頼231：止まった所の置き方と、両横に残る幅・寄せて通る所の幅を数える（廊下の中心から。m）。
値の出どころ：廊下＝closeup229_script.json（手すりの内の面 ±0.84・壁 ±0.90）、ハコブくんの幅と決まり＝229 の frames229.csv と robot_rule、
車いすの幅＝228 の報告（後ろの車輪の外 0.653）、寺島さん・大城さんの寸法＝Unity で測った terashima231.txt。
使い方: python3 geo231.py <出力フォルダ>"""
import sys, os, json
from PIL import Image, ImageDraw, ImageFont
out = sys.argv[1] if len(sys.argv) > 1 else '.'
RAIL = 0.84; WALL = 0.90
ROBOT_HALF = 0.84 - 0.1905 - 0.33          # 229：x −0.33 で手すりと 0.1905 → 半分の幅 0.3195
RAIL_CLEAR = 0.053; GAP = 0.15             # 229 の決まり（手すりと 0.053・人や車いすと 0.15 より狭いなら止まる）
NEED = RAIL_CLEAR + 2 * ROBOT_HALF + GAP   # 手すりの側を通る時に要る幅
CHAIR_HALF = 0.653 / 2
T_BACK, T_FRONT = 0.1399, 0.1499           # 寺島さん 奥行（作った時の姿勢・前 +0.1499・後ろ −0.1399）
T_HALF_W = 0.2381                          # 寺島さん 腕を含む幅の半分
O_HALF_W = 0.2381; O_DEPTH_HALF = 0.157    # 大城さん
WC_AHEAD = 0.594                           # 車いすの根は大城さんの根の前 0.594（228）
# 止まった所（提案ではなく、依頼の置き方どおりに置いた時の値）
chair_x = 0.0
oshiro_x = 0.0
tera_x = -0.55                             # 寺島さんの根（+x を向く）。大城さんの体の −x の端 −0.238 と 0.16 m あける
L = []
def p(s): print(s); L.append(s)
p(f"ハコブくんの幅 {2*ROBOT_HALF:.3f} m（手すりの高さ）・手すりの側を通るのに要る幅 = 手すり {RAIL_CLEAR} + 幅 {2*ROBOT_HALF:.3f} + すき間 {GAP} = {NEED:.3f} m")
p("■ 止まった時（車いす x 0.00・向き 0°、大城さん x 0.00、寺島さん x %.2f で +x を向く）" % tera_x)
cl = (chair_x - CHAIR_HALF) - (-RAIL); cr = RAIL - (chair_x + CHAIR_HALF)
p(f"  車いすの所：−x 側 {cl:.3f} m・+x 側 {cr:.3f} m（どちらも {NEED:.3f} より狭い → 通れない）")
tl = (tera_x - T_BACK) - (-RAIL)
orr = RAIL - (oshiro_x + O_HALF_W)
p(f"  大城さん・寺島さんの所：−x 側（寺島さんの背中と手すり）{tl:.3f} m・+x 側（大城さんと手すり）{orr:.3f} m（どちらも狭い → 通れない）")
p(f"  寺島さんの前と大城さんの体の −x の端：{(oshiro_x - O_HALF_W) - (tera_x + T_FRONT):.3f} m")
p("■ 寺島さんが −x へ半歩 0.5 m よける")
room = (tera_x - T_BACK) - (-RAIL)
p(f"  背中から手すりまで {room:.3f} m（壁まで {(tera_x - T_BACK) + WALL:.3f} m）。0.5 m よけると背中は x {tera_x - 0.5 - T_BACK:.3f}（手すりの外 {(-RAIL) - (tera_x - 0.5 - T_BACK):.3f} m・壁の外 {(-WALL) - (tera_x - 0.5 - T_BACK):.3f} m）")
p(f"  よけたあとも手すりの内に収まるには、はじめの寺島さんの根が x ≥ {-RAIL + T_BACK + 0.5:.3f}。大城さんの体（−x の端 {oshiro_x - O_HALF_W:.3f}）とぶつからないのは x ≤ {oshiro_x - O_HALF_W - T_FRONT:.3f} → 両方を満たす所は無い")
p("■ 大城さんが車いすを +x 0.42 へ寄せた後、ハコブくんが空いた間を通る（229 の通り方）")
chair_near = 0.079                         # 229：すれ違う時の一番近い車いすの点（ハコブくん x −0.4643 の右の端 −0.1448 + 0.2238）
span = chair_near - (-RAIL)
need_t = (T_BACK + T_FRONT) + GAP + 2 * ROBOT_HALF + GAP
p(f"  車いすの所の幅（−x の手すり〜車いすの一番近い点）{span:.3f} m")
p(f"  寺島さんがこの間（−x 側）に残る時に要る幅 = 寺島さんの奥行 {T_BACK+T_FRONT:.3f} + すき間 {GAP} + ハコブくん {2*ROBOT_HALF:.3f} + すき間 {GAP} = {need_t:.3f} m → {need_t-span:.3f} m 足りない")
osh_edge = 0.42 - O_HALF_W
p(f"  大城さんの所（大城さんの体の −x の端 {osh_edge:.3f}）の幅 {osh_edge + RAIL:.3f} m → {need_t-(osh_edge+RAIL):.3f} m 足りない")
p(f"  寺島さんが手すりに背中を付けても、ハコブくんの −x の端（寄った位置 x −0.4643 で {-0.4643-ROBOT_HALF:.3f}）と寺島さんの前（{-RAIL+T_BACK+T_FRONT:.3f}）が {(-RAIL+T_BACK+T_FRONT)-(-0.4643-ROBOT_HALF):.3f} m 重なる")
open(os.path.join(out, 'geo231.txt'), 'w').write('\n'.join(L) + '\n')

# 真上の図（左が −x）。1 m = 300 px
S = 300; W = int(3.0 * S); H = int(5.2 * S)
img = Image.new('RGB', (W, H), (235, 232, 224)); d = ImageDraw.Draw(img)
try: font = ImageFont.truetype('/System/Library/Fonts/ヒラギノ角ゴシック W6.ttc', 26)
except Exception: font = ImageFont.load_default()
X = lambda x: int(W / 2 + x * S); Z = lambda z: int(H - 0.4 * S - z * S)
def panel(z0, title, chair, osh, tera, robot, tera_ghost=None):
    d.rectangle([X(-WALL), Z(z0 + 2.0), X(WALL), Z(z0)], fill=(219, 214, 201))
    for sx in (-1, 1):
        d.line([X(sx * RAIL), Z(z0 + 2.0), X(sx * RAIL), Z(z0)], fill=(160, 120, 70), width=3)
        d.rectangle([X(sx * WALL) - (6 if sx < 0 else 0), Z(z0 + 2.0), X(sx * WALL) + (6 if sx > 0 else 0), Z(z0)], fill=(102, 110, 122))
    cz = z0 + 0.55
    d.rectangle([X(chair - CHAIR_HALF), Z(cz + 0.53), X(chair + CHAIR_HALF), Z(cz - 0.54)], outline=(30, 50, 110), width=3)
    d.text((X(chair) - 30, Z(cz) - 14), '車いす', fill=(30, 50, 110), font=font)
    oz = cz + WC_AHEAD + 0.15
    d.ellipse([X(osh - O_HALF_W), Z(oz + O_DEPTH_HALF), X(osh + O_HALF_W), Z(oz - O_DEPTH_HALF)], outline=(40, 83, 171), width=3)
    d.text((X(osh) - 26, Z(oz) - 14), '大城', fill=(40, 83, 171), font=font)
    d.ellipse([X(tera - T_BACK), Z(oz + T_HALF_W), X(tera + T_FRONT), Z(oz - T_HALF_W)], outline=(200, 40, 40), width=3)
    d.text((X(tera) - 26, Z(oz) - 14), '寺島', fill=(200, 40, 40), font=font)
    if tera_ghost is not None:
        d.ellipse([X(tera_ghost - T_BACK), Z(oz + T_HALF_W), X(tera_ghost + T_FRONT), Z(oz - T_HALF_W)], outline=(200, 40, 40), width=2)
        d.text((X(tera_ghost) - 20, Z(oz) + 75), '0.5 m よけた所', fill=(200, 40, 40), font=font)
    if robot is not None:
        rz = cz + 0.2
        d.rectangle([X(robot - ROBOT_HALF), Z(rz + 0.38), X(robot + ROBOT_HALF), Z(rz - 0.38)], outline=(20, 140, 100), width=3)
        d.text((X(robot) - 60, Z(rz) - 14), 'ハコブくん', fill=(20, 140, 100), font=font)
    d.text((X(-WALL), Z(z0 + 2.0) - 36), title, fill=(0, 0, 0), font=font)
panel(2.4, '止まった所（両横とも狭い）', chair_x, oshiro_x, tera_x, None)
panel(0.0, '寄せて通る所（229 の位置）', 0.42, 0.42, tera_x, -0.4643, tera_ghost=tera_x - 0.5)
img.save(os.path.join(out, 'geo231_top.png'))
