"""依頼237:make_script235.py を写して、写した先で変えた。235 から変えたこと: ・235 の⑩(止まって 3〜4 秒で茂さん「何を運んでるの?」→ハコブ「病棟へのお届け物です」)を 2 本とも消した ・⑨-1:止まって 10 秒のハコブ「すみません、通ります」のあと、茂さんが大城さんのほうへ顔を向けて(M_TURN_O)「おい、ロボットさんが通るって」→ 235 のとおり大城さんが気づいて寄せる。 走り出して車いすに近づいた所で、茂さんがハコブくんのほうへ顔を向けて「何を運んでるんだい?」→ ハコブ「病棟へのお届け物です。ありがとうございます」(帯「お届け中」→「ありがとうございます」と合わせて目まで笑う顔 1.5 秒)→ 茂さんが 10° うなずき・顔を前へ 7・8 の声は、ハコブくんが車いすの横にいる間(times.json の beside:前の端が足のせの前の端を過ぎてから、後ろの端が大城さんの後ろの端を過ぎるまで)に終わるように置く ・⑨-2:20 秒の声の後 M4_AFTER 秒で茂さんがハコブくんのほうへ顔を向けて(M_YAW)「あんたも待たされてるのかい」→ ハコブ「はい、お待ちしています」→ 茂さんは顔を戻す。 車いすの横を通る時にハコブ「ありがとうございます」+目まで笑う顔 1.5 秒・茂さんが 10° うなずく。早回しは 10〜20 秒の間(235 のまま)と、6 のあとから 30 秒の手前まで ・走り出した時の目まで笑う顔(235)はやめ、走り出したら「基本」 ・画面の stuck は帯(黄)「通れません」だけの絵 c237_stuck_band.png と、顔の板の困り顔 face237_trouble(ふだんの大きさ) 以下は 235 の説明: 依頼235:⑨「車いすが廊下の真ん中で止まる」(⑩入り)の台本 closeup235_script.json を作る。場面は 2 つ:stop_voice(⑨-1)・stop_stuck(⑨-2)。 寺島さんは別の場面 <名前>__tera(同じ台本の中。Closeup235.cs が 2 つめの CloseupDirector で動かす)。 make_script229.py を土台にした(廊下・色・光・看護師の値・握りの的・声の口の作り方・ハコブくんの決まり)。229 から変えたこと: ・車いすの根の位置・向きを毎コマ台本に書く(c235.chair)。両手で握っている間は大城さんの根の前に固く付いた位置(229 と同じ)、 立ち話で大城さんが体を回す間は止めた所のまま ・寄せ方(依頼235 の答え 1):feas235.py で出した道(その場で回る・まっすぐ前/後ろ)を、速さ 0.3 m/秒・向きの変わる速さ 25°/秒を超えない台形の速さでたどる。 後ろの車軸の中心がその道を通る(横にすべらない)。大城さんの根と向きは車いすから出す ・立ち話の向き(答え 2):大城さんは右手(寺島さんから遠い側)を握りからはなし、体ごと寺島さんへ回す(足は 2 歩踏み替える)。左手は左の握りのまま(的は世界に止めた握り) 使い方:python3 make_script229.py と同じ並び:<175 の台本> <出力の台本> <声の wav のフォルダ> <道の json(feas235.py の出力)> [times.json]""" import json, math, os, sys, wave import numpy as np def E(k, d): v = os.environ.get(k) return type(d)(v) if v is not None else d src, dst, wavdir, pathjs = sys.argv[1:5] times = json.load(open(sys.argv[5])) if len(sys.argv) > 5 and os.path.exists(sys.argv[5]) else {} S = json.load(open(src)) FPS = 30; DT = 1.0 / FPS O = list(S["corridor"]["origin"]) AXLE_BACK = 0.15 GRIP_Z = 0.3336; GRIP_X, GRIP_Y = 0.225, 0.910; GRIP_R = 0.0155 D_PUSH = 0.26 WC_AHEAD = GRIP_Z + D_PUSH # 車いすの根:大城さんの根の前(229 と同じ 0.5936) AX_AHEAD = WC_AHEAD - AXLE_BACK # 後ろの車軸の中心:大城さんの根の前 WC_FRONT = 0.64 ROBOT_FRONT, ROBOT_REAR = 0.382, 0.380 LANE_R = -0.33 V_C = 0.8 # 押す速さ(229) STEP_T = 0.5 SPINE, CHEST = 4.0, 3.0 Z_NS = E("Z_NS", 9.714) # 大城さんの根が止まる z(ハコブくんが 229 と同じ z 5.8 あたりで止まるように) NZ0 = E("NZ0", 15.0) RZ0 = E("RZ0", -1.6) TV0 = 1.0 GAP = E("GAP", 0.55) O_HW, T_F, T_B = 0.2381, 0.1499, 0.1399 T_GAP = 0.15 # 寺島さんと大城さんのすき間(233 の 0.10〜0.15 の大きいほう) T_DZ = E("T_DZ", -0.30) # 寺島さんの立つ前後(大城さんの根から。− は前):答え 2 の「手の届かない形」→ 0.3 m 前へ(turn235.py) T_X = O_HW + T_GAP + T_F # 寺島さんの根の x(立ち話)0.538 T_WALK_X = 0.539 # 追いつく時の x(大城さんの +x の端 0.238 と手すり 0.84 の真ん中) T_V = 1.2 O_TURN = E("O_TURN", 29.0) # 大城さんが体を回す角度(turn235.py:寺島さん 0.3 m 前で 29°・顔は体から −29°) T_RET = (0.65, 0.69) # 寺島さんが下がって立つ所(x、大城さんの止まった根からの z)。feas235.py の TX・TZ def smooth(u): u = min(1, max(0, u)); return u * u * (3 - 2 * u) q = lambda t: round(round(t * FPS) / FPS, 4) # ---------------------------------------------------------------- 声(233 の audio) LINES = {"V1": ("tera", "V1_terashima_oshirosan.wav", "大城さん"), "V2": ("nurse", "V2_oshiro_otsukare.wav", "あ、寺島さん。おつかれさま"), "H2": ("robot", "H2_hakobu_toorimasu.wav", "すみません、通ります"), "T2": ("tera", "T2_terashima_hakobukun.wav", "あ、ハコブくん"), "V8": ("nurse", "V8_oshiro_gomenne.wav", "あ、ごめんね"), # 依頼237 の新しい声 "M2": ("morita", "M2_morita_tooru.wav", "おい、ロボットさんが通るって"), "M3": ("morita", "M3_morita_nanida.wav", "何を運んでるんだい?"), "M4": ("morita", "M4_morita_matasare.wav", "あんたも待たされてるのかい"), "H3": ("robot", "H3_hakobu_otodoke_arigato.wav", "病棟へのお届け物です。ありがとうございます"), "H4": ("robot", "H4_hakobu_omachi.wav", "はい、お待ちしています"), "H5": ("robot", "H5_hakobu_arigato.wav", "ありがとうございます")} SR = 48000 def load_wav(p): w = wave.open(p); x = np.frombuffer(w.readframes(w.getnframes()), np.int16).astype(np.float64) / 32768.0 assert w.getframerate() == SR and w.getnchannels() == 1, p return x def voiced(x, th_db=-45.0): hop = 480 e = np.array([np.sqrt(np.mean(x[i:i + hop] ** 2)) for i in range(0, len(x) - hop, hop)]) on = np.where(20 * np.log10(e + 1e-9) > th_db)[0] return on[0] * hop / SR, (on[-1] + 1) * hop / SR clips = {} for k, (who, fn, text) in LINES.items(): x = load_wav(os.path.join(wavdir, fn)); v0, v1 = voiced(x) clips[k] = {"who": who, "file": fn, "text": text, "x": x, "v0": v0, "v1": v1, "dur": v1 - v0, "len": len(x) / SR} def inner_gap(x, th_db=-45.0, min_s=0.3): """依頼237:声の中の一番長い無音(min_s 秒以上)の終わり(クリップの秒)= H3 の「ありがとうございます」の始まり""" hop = 480 e = np.array([np.sqrt(np.mean(x[i:i + hop] ** 2)) for i in range(0, len(x) - hop, hop)]) v = 20 * np.log10(e + 1e-9) > th_db; on = np.where(v)[0]; best = None; i = on[0] while i < on[-1]: if not v[i]: j = i while not v[j]: j += 1 if (j - i) * hop / SR >= min_s and (best is None or j - i > best[1] - best[0]): best = (i, j) i = j i += 1 return best[1] * hop / SR H3_ARIGATO = inner_gap(clips["H3"]["x"]) - clips["H3"]["v0"] # 声の始まりから「ありがとうございます」の始まりまで GAP_Q = E("GAP_Q", 0.4) # 依頼237:新しいやり取りのセリフの間(235 の決まり 0.4〜0.7 の短いほう。⑨-1 の動けない時間を 30 秒未満にするため) M_TURN_O = E("M_TURN_O", -40.0) # ⑨-1 の 5:茂さんが後ろの大城さんのほうへ顔を向ける(30〜45°。− は +x の側=大城さんが寺島さんのほうへ向いている側) M_YAW = E("M_YAW", 25.0) # ⑨-2 の 5:ハコブくんのほうへ(20〜30°。235 の⑩と同じ 25°) M4_AFTER = E("M4_AFTER", 2.5) # ⑨-2 の 5:20 秒の声が終わってから(2〜4 秒) HAPPY_S = 1.5 RULE = { "about": "ハコブくんの決まり(依頼228・229 のまま)。依頼235 で足したのは resume_still_s(止まった後、前の物が resume_still_s 秒動かず、寄った位置で gap_stop_m 以上あけて通れる時に走り出す)と、通り過ぎてから x −0.33 へ戻ること", "cruise_mps": 0.6, "slow_mps": 0.5, "accel_max_mps2": 0.4, "decel_max_mps2": 0.4, "jerk_max_mps3": 1.0, "detect_range_m": 6.0, "react_s": 0.1, "margin_m": 2.4, "gap_slow_m": 0.40, "gap_stop_m": 0.15, "lane_x": LANE_R, "wall_clear_m": 0.053, "lateral_max_mps": 0.15, "lateral_angle_deg": 15.0, "lateral_accel_mps2": 0.25, "lateral_gain": 2.0, "lateral_done_m": 0.03, "resume_lateral_angle_deg": 10.0, "turn_rate_dps": 30.0, "corner_half_len_m": 0.38, "corner_slack_m": 0.006, "pass_behind_m": 1.0, "resume_still_s": 0.5, "still_mps": 0.005, } # ---------------------------------------------------------------- 1. 押して来て止まる(x 0・向き 180°) TW0, RAMP, T_DEC = 0.2, 1.0, 1.6 d_dec = V_C * T_DEC / 2 d_total = NZ0 - Z_NS t_cr0 = TW0 + RAMP; d_ramp = V_C * RAMP / 2 t_dec0 = t_cr0 + (d_total - d_ramp - d_dec) / V_C t_ns = t_dec0 + T_DEC def oshiro_push_z(t): if t <= TW0: return NZ0 if t <= t_cr0: u = (t - TW0) / RAMP; return NZ0 - V_C * RAMP * (u ** 3 - 0.5 * u ** 4) # 速さ smooth(u)·V の積分 if t <= t_dec0: return NZ0 - d_ramp - V_C * (t - t_cr0) if t <= t_ns: u = (t - t_dec0) / T_DEC; return NZ0 - d_ramp - V_C * (t_dec0 - t_cr0) - V_C * T_DEC * (u - (u ** 3 - 0.5 * u ** 4)) return Z_NS # smooth の積分:∫0^u (3s²−2s³) ds = u³ − u⁴/2(u=1 で 0.5) assert abs(oshiro_push_z(t_ns) - Z_NS) < 1e-6 # ---------------------------------------------------------------- 2. 寺島さん:後ろから 1.2 m/秒で追いつき、横に並んで「大城さん」、止まって大城さんへ向く t_v1 = t_dec0 - 0.4 # 横に並んだ時(大城さんはまだ 0.8 m/秒)に「大城さん」 z_al = oshiro_push_z(t_v1) T_TD = 2.1 # 寺島さんの減速(1.2 → 0・なめらか) z_tstop = Z_NS + T_DZ t_ts = t_v1 + T_TD assert abs((z_al - z_tstop) - T_V * T_TD / 2) < 0.08, (z_al - z_tstop, T_V * T_TD / 2) T_TD = (z_al - z_tstop) * 2 / T_V; t_ts = t_v1 + T_TD TZ0 = E("TZ0", z_al + T_V * (t_v1 - 0.2)) # 0.2 秒で 1.2 m/秒(はじめから歩いている) def tera_z(t): if t <= t_v1: return z_al + T_V * (t_v1 - t) if t <= t_ts: u = (t - t_v1) / T_TD; return z_al - T_V * T_TD * (u - (u ** 3 - 0.5 * u ** 4)) return z_tstop YAW_FACE_O = math.degrees(math.atan2(0.0 - T_X, Z_NS - z_tstop)) % 360 # 大城さんの根のほうへ(299°) t_tturn0, t_tturn1 = t_ts - 0.5, t_ts + 0.5 # 減速の終わりで向きを変える(2 歩) def tera_x(t): return T_WALK_X + (T_X - T_WALK_X) * smooth((t - t_tturn0) / (t_tturn1 - t_tturn0)) def tera_yaw0(t): return 180.0 + (YAW_FACE_O - 180.0) * smooth((t - t_tturn0) / (t_tturn1 - t_tturn0)) # ---------------------------------------------------------------- 3. 大城さんが振り返る(右手をはなし、体を 29° 回す・2 歩) t_rel0 = t_ns + 0.25; t_rel1 = t_rel0 + 0.5 # 右手の重み 1 → 0 t_oturn0 = t_ns + 0.35; t_oturn1 = t_oturn0 + 0.9 # 向き 180 → 151 on = {"V1": t_v1} on["V2"] = max(t_oturn0 + 0.45, on["V1"] + clips["V1"]["dur"] + GAP) T_STOP_EST = on["V2"] + clips["V2"]["dur"] + 2.5 t_stop = times.get("stop_t", T_STOP_EST) z_rstop = times.get("robot_stop_z", 5.8); x_rstop = times.get("robot_stop_x", -0.4643) # ---------------------------------------------------------------- 4. 寄せる道(feas235.py の道を時間に) P = json.load(open(pathjs)) pts = P["path"] segs = [] for p in pts[1:]: if not segs or segs[-1]["kind"] != p[3]: segs.append({"kind": p[3], "pts": []}) segs[-1]["pts"].append(p) V_MAX, W_MAX, ACC_T, PAUSE = E("V_MAX", 0.28), E("W_MAX", 23.0), 0.3, 0.15 # 上限 0.3 m/秒・25°/秒より少し下 def trap(d, vmax, ta): T = d / vmax + ta def f(t): if t <= 0: return 0.0 if t >= T: return d if t < ta: return vmax * t * t / (2 * ta) if t > T - ta: return d - vmax * (T - t) ** 2 / (2 * ta) return vmax * (t - ta / 2) return T, f start = pts[0] man = [] # (時間の長さ, 関数 u→(ax, az, th)) cur = (start[0], start[1], start[2]) for sg in segs: end = sg["pts"][-1] if sg["kind"] == "r": dth = end[2] - cur[2]; T, f = trap(abs(dth), W_MAX, 0.2); c0 = cur man.append((T, (lambda f, c0, dth: lambda t: (c0[0], c0[1], c0[2] + math.copysign(f(t), dth)))(f, c0, dth))) else: d = math.hypot(end[0] - cur[0], end[1] - cur[1]); T, f = trap(d, V_MAX, ACC_T); c0 = cur; e0 = (end[0], end[1]) man.append((T, (lambda f, c0, e0, d: lambda t: (c0[0] + (e0[0] - c0[0]) * f(t) / d, c0[1] + (e0[1] - c0[1]) * f(t) / d, c0[2]))(f, c0, e0, d))) cur = (end[0], end[1], end[2]) MAN_T = sum(T for T, _ in man) + PAUSE * (len(man) - 1) AX0_Z = Z_NS - AX_AHEAD # 止まった時の車軸の z(向き 0) def man_at(t): """寄せ始めから t 秒の (車軸 x, 車軸 z, 向き°)。feas の z は前=−(車軸の止まった所から)""" for T, fn in man: if t <= T: a = fn(t); return a[0], AX0_Z + a[1], a[2] t -= T if t <= PAUSE: a = fn(T); return a[0], AX0_Z + a[1], a[2] t -= PAUSE a = man[-1][1](man[-1][0]); return a[0], AX0_Z + a[1], a[2] # ---------------------------------------------------------------- 場面ごと def build(variant): stuck = variant == "stop_stuck" on2 = dict(on) ev = {} tv = times.get(variant, {}) # 声をかける(235 のまま:10 秒・20 秒) calls = [t_stop + 10.0] + ([t_stop + 20.0] if stuck else []) on2["H2"] = calls[0] if stuck: on2["H2b"] = calls[1] endH2 = on2["H2"] + clips["H2"]["dur"] t30 = t_stop + 30.0 NOD_DOWN, NOD_HOLD, NOD_BACK = 0.28, 0.10, 0.32 if stuck: # 依頼237 ⑨-2 の 5・6:20 秒の声のあと M4_AFTER 秒で茂さん→ハコブくんが答える→茂さんは顔を戻す endH2b = on2["H2b"] + clips["H2"]["dur"] on2["M4"] = endH2b + M4_AFTER t_m_turn0 = on2["M4"] - 0.45; t_m_turn1 = on2["M4"] on2["H4"] = on2["M4"] + clips["M4"]["dur"] + GAP_Q endH4 = on2["H4"] + clips["H4"]["dur"] m_back0 = endH4 + 0.3; m_back1 = m_back0 + 0.6 t_tlook0 = t30 + E("TLOOK_AFTER", 1.2); t_tlook1 = t_tlook0 + 0.4; t_tback0 = t_tlook1 + 0.35; t_tback1 = t_tback0 + 0.4 on2["T2"] = t_tback1 + 0.05 cue_end = on2["T2"] + clips["T2"]["dur"] on2["V8"] = cue_end + GAP else: # 依頼237 ⑨-1 の 5:茂さんが先に気づき、大城さんのほうへ顔を向けて「おい、ロボットさんが通るって」 t_mo0 = endH2 + 0.05; t_mo1 = t_mo0 + 0.45 on2["M2"] = endH2 + GAP_Q cue_end = on2["M2"] + clips["M2"]["dur"] on2["V8"] = cue_end + GAP_Q # 大城さんが気づく:顔をハコブくんへ(cue_end+0.25)・体を戻して両手で握り直す(+0.45 から 0.9 秒)・「あ、ごめんね」(235 のまま) t_olook0 = cue_end + 0.25; t_olook1 = t_olook0 + 0.35 t_oback0 = cue_end + 0.45; t_oback1 = t_oback0 + 0.9 t_regrip0 = t_oback1 + 0.1; t_regrip1 = t_regrip0 + 1.0 # 体を戻し終わってから右手を上から握りへ endV8 = on2["V8"] + clips["V8"]["dur"] if not stuck: m_ob0 = endV8 + 0.2; m_ob1 = m_ob0 + 0.6 # 茂さんは顔を前へ戻す(大城さんが顔を戻すのと同じ時) t_olookback0 = endV8 + 0.2; t_olookback1 = t_olookback0 + 0.45 # 寺島さんが下がる(V8 の始まり+0.3 から):向きを変え(後ろ=+z へ)・歩いて・手すりを背に −x を向く t_tr0 = on2["V8"] + 0.3 TR_TURN1, TR_WALK, TR_TURN2 = 0.8, 1.6, 0.8 t_tr1 = t_tr0 + TR_TURN1; t_tr2 = t_tr1 + TR_WALK; t_tr3 = t_tr2 + TR_TURN2 # 寄せ始め:握り直しと寺島さんが下がり終わった後 t_man0 = max(t_regrip1 + 0.2, t_tr3 + 0.1) t_man1 = t_man0 + MAN_T t_resume_est = t_man1 + 0.512 t_resume = tv.get("resume_t", t_resume_est) t_exit = tv.get("passed_t", t_resume + 9.833) + 2.5 # 依頼237:ハコブくんが車いすの横にいる間(前の端が足のせの前の端を過ぎてから、後ろの端が大城さんの後ろの端を過ぎるまで。1 回目の Unity の値・無ければ 235 の差) bs = tv.get("beside", [t_resume + 5.0, t_resume + 8.533]) if stuck: # ⑨-2 の 8:横を通る時に「ありがとうございます」(横にいる間の真ん中) on2["H5"] = bs[0] + (bs[1] - bs[0] - clips["H5"]["dur"]) / 2 happy_from = on2["H5"] endH5 = on2["H5"] + clips["H5"]["dur"] nod_t0 = endH5 + 0.25 else: # ⑨-1 の 7・8:茂さんの声が横に来た所(bs[0])+0.05 で終わり、GAP_Q あけてハコブくんが答える(横にいる間に 2 つとも終わる) on2["M3"] = bs[0] + E("M3_END_AFTER", 0.05) - clips["M3"]["dur"] on2["H3"] = on2["M3"] + clips["M3"]["dur"] + GAP_Q happy_from = on2["H3"] + H3_ARIGATO endH3 = on2["H3"] + clips["H3"]["dur"] t_m3_0 = on2["M3"] - 0.45; t_m3_1 = on2["M3"] M_YAW3 = tv.get("m3_yaw", 35.0) nod_t0 = endH3 + 0.25 happy_to = happy_from + HAPPY_S m_end0 = nod_t0 + NOD_DOWN + NOD_HOLD + NOD_BACK + 0.3; m_end1 = m_end0 + 0.6 DUR = q(t_exit) NF = int(round(DUR * FPS)) ev.update({"t_stop": t_stop, "t30": t30 if stuck else None, "t_man0": t_man0, "t_man1": t_man1, "t_resume_used": t_resume, "t_exit_used": t_exit, "t_tr": [t_tr0, t_tr3], "t_oturn": [t_oturn0, t_oturn1], "t_oback": [t_oback0, t_oback1], "t_rel": [t_rel0, t_rel1], "t_regrip": [t_regrip0, t_regrip1]}) # ---------- 大城さんの根・向き、車いすの根・向き(毎コマ) nurse_rows, chair_rows, grip_both = [], [], [] for f in range(NF + 1): t = f * DT if t < t_man0: ax, az, th = 0.0, oshiro_push_z(t) - AX_AHEAD, 0.0 nx_, nz_ = 0.0, oshiro_push_z(t) if t < t_oturn0: nyaw = 180.0 elif t < t_oback0: nyaw = 180.0 - O_TURN * smooth((t - t_oturn0) / (t_oturn1 - t_oturn0)) else: nyaw = 180.0 - O_TURN * (1 - smooth((t - t_oback0) / (t_oback1 - t_oback0))) else: ax, az, th = man_at(t - t_man0) fx, fz = math.sin(math.radians(th)), -math.cos(math.radians(th)) nx_, nz_ = ax - fx * AX_AHEAD, az - fz * AX_AHEAD; nyaw = 180.0 - th # 車いすの根:車軸の前 0.15(向き th) fx, fz = math.sin(math.radians(th)), -math.cos(math.radians(th)) cx, cz = ax + fx * AXLE_BACK, az + fz * AXLE_BACK nurse_rows.append((t, nx_, nz_, nyaw)); chair_rows.append((round(cx, 5), round(cz, 5), round(180.0 - th, 4))) grip_both.append(not (t_rel0 <= t < t_regrip1)) keys_x = [[round(r[0], 4), round(r[1], 5), "lin"] for r in nurse_rows]; keys_x[0] = keys_x[0][:2] keys_z = [[round(r[0], 4), round(r[2], 5), "lin"] for r in nurse_rows]; keys_z[0] = keys_z[0][:2] keys_yaw = [[round(r[0], 4), round(r[3], 4), "lin"] for r in nurse_rows]; keys_yaw[0] = keys_yaw[0][:2] # ---------- 大城さんの足 def walk_steps(t0, t1, first="R", period=STEP_T): st, t, foot = [], t0, first while t + period <= t1 + 1e-6: st.append([round(t, 4), round(t + period, 4), foot]); t += period; foot = "L" if foot == "R" else "R" return st, foot steps, foot = walk_steps(TW0, t_ns + 0.25) # 振り返る(2 歩:寺島さん側の左足から)・戻る(2 歩) steps += [[round(t_oturn0, 4), round(t_oturn0 + 0.45, 4), "L"], [round(t_oturn0 + 0.45, 4), round(t_oturn0 + 0.9, 4), "R"]] steps += [[round(t_oback0, 4), round(t_oback0 + 0.45, 4), "R"], [round(t_oback0 + 0.45, 4), round(t_oback0 + 0.9, 4), "L"]] # 寄せる間:根が動く/回る間は 0.45 秒ごとに交互に踏む(最後にそろえる 1 歩) mv = [] prev = None for f in range(int(t_man0 * FPS), NF + 1): r = nurse_rows[f] if prev is not None: mv.append((r[0], math.hypot(r[1] - prev[1], r[2] - prev[2]) / DT + abs(r[3] - prev[3]) / DT * 0.01)) prev = r moving = [t for t, v in mv if v > 0.004] if moving: t, ft, tend = moving[0] - 0.05, "R", moving[-1] while t < tend + 0.3: steps.append([round(t, 4), round(t + 0.45, 4), ft]); t += 0.45; ft = "L" if ft == "R" else "R" steps.append([round(t, 4), round(t + 0.45, 4), ft]) steps.sort(key=lambda s: s[0]) # ---------- 大城さんの手:右手は振り返る間はなす。左手は世界に止めた握り gz = WC_AHEAD - GRIP_Z py = GRIP_Y + GRIP_R + 0.018 gl_world = [round(GRIP_X, 4), round(py, 4), round(Z_NS - (gz - 0.05), 4)] L_target = [[0, "grip_l"], [round(t_oturn0 - 0.02, 4), "grip_l_w", 0.01], [round(t_oback1, 4), "grip_l", 0.01]] # 右手:はなす時は握りの上へ上げてから下ろす・握り直す時は上から下ろしてのせる(握りの筒を通らない) R_w = [[0, 1.0], [round(t_rel0 + 0.35, 4), 1.0], [round(t_rel1 + 0.35, 4), 0.0], [round(t_regrip0, 4), 0.0], [round(t_regrip0 + 0.55, 4), 1.0]] R_target = [[0, "grip_r"], [round(t_rel0, 4), "grip_r_up", 0.35], [round(t_regrip0 - 0.05, 4), "grip_r_up", 0.01], [round(t_regrip0 + 0.55, 4), "grip_r", 0.4]] R_curl = [[0, 30.0], [round(t_rel0, 4), 30.0], [round(t_rel1, 4), 8.0], [round(t_regrip0, 4), 8.0], [round(t_regrip1, 4), 30.0]] spine = [[0, SPINE], [round(t_oturn0, 4), SPINE], [round(t_oturn1, 4), 2.0], [round(t_oback0, 4), 2.0], [round(t_oback1, 4), SPINE]] chest = [[0, CHEST], [round(t_oturn0, 4), CHEST], [round(t_oturn1, 4), 1.0], [round(t_oback0, 4), 1.0], [round(t_oback1, 4), CHEST]] walk = [[0, 0], [TW0, 0], [TW0 + 0.4, 1], [round(t_dec0 + 0.6, 4), 1], [round(t_ns, 4), 0]] # ---------- 顔の向き:寺島さんを見る(体から 30° 以内)・ハコブくんを見る EYE_Y = 1.50 t_head = (t_oturn0 + 0.2, t_oturn1) def look_yaw(nx_, nz_, byaw, tx, tz): want = math.degrees(math.atan2(tx - nx_, tz - nz_)); return ((want - byaw + 180) % 360) - 180 hy = [[0, 0.0], [round(t_head[0], 4), 0.0]] hn = [[0, 8.0], [round(t_head[0], 4), 8.0], [round(t_head[1], 4), 0.0]] o_to_t = look_yaw(0.0, Z_NS, 180.0 - O_TURN, T_X - 0.05, z_tstop) o_to_t = max(-30.0, min(30.0, o_to_t)) hy.append([round(t_head[1], 4), round(o_to_t, 3)]) # 立ち話のうなずき(聞く側)・話す(口だけ talk) talk_o, talk_t = [[0, 0]], [[0, 0]] nod_o, nod_t = [], [] t_talk0 = on2["V2"] + clips["V2"]["dur"] + 0.6 t_talk_end_o = cue_end + 0.1 t_talk_end_t = on2["V8"] if not stuck else t_tlook0 - 0.1 t, who = t_talk0, "t" while t < max(t_talk_end_o, t_talk_end_t) - 0.5: L = 2.6 if who == "t" else 2.2 if who == "t" and t < t_talk_end_t - 0.3: talk_t += [[round(t, 4), 1], [round(min(t + L, t_talk_end_t - 0.1), 4), 0]] if t + 1.2 < t_talk_end_o: nod_o.append(t + 1.0) elif who == "o" and t < t_talk_end_o - 0.3: talk_o += [[round(t, 4), 1], [round(min(t + L, t_talk_end_o - 0.1), 4), 0]] if t + 1.2 < t_talk_end_t: nod_t.append(t + 1.1) t += L + 0.5; who = "o" if who == "t" else "t" for tn in nod_o: hn += [[round(tn, 4), 0.0], [round(tn + 0.25, 4), 7.0], [round(tn + 0.55, 4), 0.0]] hn.sort(key=lambda r: r[0]) # 気づく o_to_r = look_yaw(0.0, Z_NS, 180.0, x_rstop, z_rstop + ROBOT_FRONT) hy += [[round(t_olook0, 4), round(o_to_t, 3)], [round(t_olook1, 4), round(o_to_r - (180.0 - (180.0 - O_TURN)), 3)], [round(t_oback0, 4), round(o_to_r - O_TURN, 3)], [round(t_oback1, 4), round(o_to_r, 3)], [round(t_olookback0, 4), round(o_to_r, 3)], [round(t_olookback1, 4), 0.0]] hn += [[round(t_olook0, 4), 0.0], [round(t_olook1, 4), 4.0], [round(t_olookback1, 4), 8.0]] hy.sort(key=lambda r: r[0]); hn.sort(key=lambda r: r[0]) mouth_o = [[0, "flat"], [round(on2["V2"] - 0.2, 4), "smile"]] # ---------- 寺島さんの道 t_rows = [] zr = Z_NS + T_RET[1]; xr = T_RET[0] ret_yaw = 0.0 # 下がる向き(+z) for f in range(NF + 1): t = f * DT if t < t_tr0: x, z, y = tera_x(t), tera_z(t), tera_yaw0(t) elif t < t_tr1: x, z, y = T_X, z_tstop, YAW_FACE_O + (((ret_yaw - YAW_FACE_O + 180) % 360) - 180) * smooth((t - t_tr0) / TR_TURN1) elif t < t_tr2: u = smooth((t - t_tr1) / TR_WALK); x, z, y = T_X, z_tstop + (zr - z_tstop) * u, ret_yaw else: u = (t - t_tr2) / TR_TURN2 x, z, y = T_X + (xr - T_X) * smooth(2 * u - 1), zr, ret_yaw + (((270.0 - ret_yaw + 180) % 360) - 180) * smooth(u) t_rows.append((t, x, z, y)) tk = lambda i: [[round(r[0], 4), round(r[i], 5), "lin"] for r in t_rows] tx_, tz_, ty_ = tk(1), tk(2), tk(3) for a in (tx_, tz_, ty_): a[0] = a[0][:2] t_steps = [] tt, ft = 0.2, "R" while tt + 0.45 <= t_ts + 0.05: t_steps.append([round(tt, 4), round(tt + 0.45, 4), ft]); tt += 0.45; ft = "L" if ft == "R" else "R" t_steps += [[round(t_tturn1 - 0.2, 4), round(t_tturn1 + 0.25, 4), ft]] ft = "L" if ft == "R" else "R" t_steps += [[round(t_tr0, 4), round(t_tr0 + 0.4, 4), "R"], [round(t_tr0 + 0.4, 4), round(t_tr0 + 0.8, 4), "L"]] tt, ft = t_tr1, "R" while tt + 0.4 <= t_tr2 + 0.05: t_steps.append([round(tt, 4), round(tt + 0.4, 4), ft]); tt += 0.4; ft = "L" if ft == "R" else "R" t_steps += [[round(t_tr2, 4), round(t_tr2 + 0.4, 4), ft], [round(t_tr2 + 0.4, 4), round(t_tr2 + 0.8, 4), "L" if ft == "R" else "R"]] t_steps.sort(key=lambda s: s[0]) t_walk = [[0, 1], [round(t_v1 + 0.6, 4), 1], [round(t_ts, 4), 0], [round(t_tr1, 4), 0], [round(t_tr1 + 0.3, 4), 0.6], [round(t_tr2 - 0.3, 4), 0.6], [round(t_tr2, 4), 0]] # 寺島さんの顔:大城さんの顔を見る(立ち話)。⑨-2 はハコブくんのほうへ −30°(20〜35°)向けて戻す def t_look_o(t): r = nurse_rows[min(len(nurse_rows) - 1, int(round(t * FPS)))] return look_yaw(T_X, z_tstop, YAW_FACE_O, r[1], r[2]) thy = [[0, 0.0], [round(t_tturn1, 4), 0.0], [round(t_tturn1 + 0.4, 4), round(max(-30, min(30, t_look_o(t_tturn1 + 0.4))), 3)]] if stuck: base = round(max(-30, min(30, t_look_o(t_tlook0))), 3) thy += [[round(t_tlook0, 4), base], [round(t_tlook1, 4), round(base - E("T_LOOK", 30.0), 3)], [round(t_tback0, 4), round(base - E("T_LOOK", 30.0), 3)], [round(t_tback1, 4), base]] thy += [[round(t_tr0, 4), round(max(-30, min(30, t_look_o(t_tr0))), 3)], [round(t_tr0 + 0.5, 4), 0.0]] thn = [[0, 6.0], [round(t_ts, 4), 0.0]] for tn in nod_t: thn += [[round(tn, 4), 0.0], [round(tn + 0.25, 4), 7.0], [round(tn + 0.55, 4), 0.0]] thn.sort(key=lambda r: r[0]) mouth_t = [[0, "flat"], [round(t_v1 - 0.3, 4), "smile"]] # ---------- 茂さん if stuck: m_yaw = [[0, 0.0], [round(t_m_turn0, 4), 0.0], [round(t_m_turn1, 4), M_YAW], [round(m_back0, 4), M_YAW], [round(m_back1, 4), 0.0]] else: m_yaw = [[0, 0.0], [round(t_mo0, 4), 0.0], [round(t_mo1, 4), M_TURN_O], [round(m_ob0, 4), M_TURN_O], [round(m_ob1, 4), 0.0], [round(t_m3_0, 4), 0.0], [round(t_m3_1, 4), M_YAW3], [round(m_end0, 4), M_YAW3], [round(m_end1, 4), 0.0]] m_nod = [[0, 0.0], [round(nod_t0, 4), 0.0], [round(nod_t0 + NOD_DOWN, 4), 10.0], [round(nod_t0 + NOD_DOWN + NOD_HOLD, 4), 10.0], [round(nod_t0 + NOD_DOWN + NOD_HOLD + NOD_BACK, 4), 0.0]] m_mouth = [[0, "flat"]] # ---------- 画面 scr = [[0, "face"], [q(t_stop + 0.2), "wait"], [q(on2["H2"]), "pass"]] if stuck: scr += [[q(on2["H2"] + 3.0), "wait"], [q(on2["H2b"]), "pass"], [q(on2["H2b"] + 3.0), "wait"], [q(t30), "stuck"]] scr += [[q(t_resume), "face"]] # 依頼237:走り出したら帯を消して「基本」 if not stuck: scr += [[q(on2["H3"]), "deliv"]] scr += [[q(happy_from), "happy"], [q(happy_to), "face"]] ring = [[0, "normal"]] + ([[q(t30), "wait"], [q(t_resume), "normal"]] if stuck else []) # ---------- 声の並び・口 tracks = {w: np.zeros(int(DUR * SR) + SR) for w in ("nurse", "robot", "tera", "morita")} place = {} for k, t0 in on2.items(): c = clips["H2" if k == "H2b" else k] s0 = t0 - c["v0"]; i0 = int(round(s0 * SR)) tracks[c["who"]][i0:i0 + len(c["x"])] += c["x"] place[k] = {"who": c["who"], "file": c["file"], "text": c["text"], "clip_start_s": round(s0, 4), "voice_on_s": round(t0, 4), "voice_off_s": round(t0 + c["dur"], 4), "voice_len_s": round(c["dur"], 4), "clip_len_s": round(c["len"], 4)} HOP = SR // FPS def frame_rms(x): return np.array([np.sqrt(np.mean(x[i * HOP:(i + 1) * HOP] ** 2)) if i * HOP < len(x) else 0 for i in range(NF)]) def ladder(who, rest, speak): rms = frame_rms(tracks[who]) ref = np.percentile(rms[rms > 0.01], 90) if (rms > 0.01).any() else 1.0 lvl = np.convolve(rms / ref, np.ones(3) / 3, mode="same") target = np.where(speak, np.digitize(lvl, [0.15, 0.35, 0.65]), 0) for i in range(NF): if not speak[i]: target[i] = rest[i] for i in range(1, NF - 1): if target[i] != target[i - 1] and target[i] != target[i + 1]: target[i] = target[i - 1] step = np.zeros(NF, int) for i in range(NF): prev = step[i - 1] if i else rest[0] step[i] = prev + int(np.clip(target[i] - prev, -1, 1)) if i % 2 == 0 else prev return step def speak_mask(names): m = np.zeros(NF, bool) for k in names: if k in on2: m[int(math.floor(on2[k] * FPS)):int(math.ceil(place[k]["voice_off_s"] * FPS))] = True return m LADDER = ["closed", "small", "mid", "large"] robot_mouth = [LADDER[s] for s in ladder("robot", np.full(NF, 2), speak_mask(["H2", "H2b", "H3", "H4", "H5"]))] nurse_mouth = [int(s) for s in ladder("nurse", np.zeros(NF, int), speak_mask(["V2", "V8"]))] tera_mouth = [int(s) for s in ladder("tera", np.zeros(NF, int), speak_mask(["V1", "T2"]))] mor_mouth = [int(s) for s in ladder("morita", np.zeros(NF, int), speak_mask(["M2", "M3", "M4"]))] mix = sum(tracks.values())[: int(round(DUR * SR))] pk = float(np.max(np.abs(mix))); assert pk < 1.0, pk wav_out = os.path.join(os.path.dirname(dst), f"mix237_{variant}.wav") w = wave.open(wav_out, "w"); w.setnchannels(1); w.setsampwidth(2); w.setframerate(SR) w.writeframes((np.clip(mix, -1, 1) * 32767).astype(np.int16).tobytes()); w.close() # ---------- カメラ zc = z_rstop + 0.7 zf = z_rstop + ROBOT_FRONT CAM = { "main": {"pos": [-0.62, 1.72, round(zc - 6.0, 4)], "look": [0.12, 0.8, round(zc + 1.6, 4)], "fov": 38}, "screen_close": {"follow": "robot", "pos": [x_rstop, 1.23, 1.15], "look": [x_rstop, 0.962, 0.29], "fov": 24}, "morita_face": {"pos": [-0.42, 1.22, round(Z_NS - WC_AHEAD - 1.25, 4)], "look": [0.02, 1.12, round(Z_NS - WC_AHEAD + 0.02, 4)], "fov": 24}, "oshiro_face": {"pos": [-0.62, 1.62, round(Z_NS - 1.75, 4)], "look": [0.05, 1.45, round(Z_NS, 4)], "fov": 22}, "depart": {"pos": [-0.75, 1.70, round(z_rstop - 1.4, 4)], "look": [0.20, 0.75, round(z_rstop + 3.2, 4)], "fov": 46}, "chk_grip": {"pos": [0.05, 1.55, round(Z_NS + 0.75, 4)], "look": [0.10, 0.95, round(Z_NS - 0.25, 4)], "fov": 40}, } # 依頼237:235 の⑩の切りかえ(茂さんの顔→画面→本番)を、新しいやり取りに使う(茂さんが話す時は茂さんの顔・ハコブくんが答える時は画面) cuts = [[0, "main"], [q(t_stop - 0.1), "screen_close"], [q(t_stop + 1.6), "main"], [q(on2["H2"] - 0.15), "screen_close"]] if stuck: cuts += [[q(endH2 + 0.15), "main"], [q(on2["H2b"] - 0.15), "screen_close"], [q(on2["H2b"] + clips["H2"]["dur"] + 0.15), "main"], [q(on2["M4"] - 0.35), "morita_face"], [q(on2["H4"] - 0.15), "screen_close"], [q(endH4 + 0.4), "main"], [q(t30 - 0.1), "screen_close"], [q(t30 + 1.0), "main"]] else: cuts += [[q(endH2 + 0.15), "morita_face"]] cuts += [[q(t_olook0 - 0.1), "oshiro_face"], [q(endV8 + 0.35), "main"]] # 依頼237:通る時にハコブくんが話す所も、235 と同じくハコブくんが話す時は画面の寄り(screen_close はハコブくんに付いて動く)→ 目まで笑う顔が終わったら本番 #(茂さんの顔のカメラはハコブくんの通る所に置いてあるので、通る間は使わない) cuts += [[q(on2["H5" if stuck else "H3"] - 0.15), "screen_close"], [q(happy_to + 0.15), "main"]] cuts.sort(key=lambda c: c[0]) stills = [[q(t_v1 + 0.3), "main", "s01_terashima_calls"], [q(on2["V2"] + 1.0), "main", "s02_three_talk"], [q(t_stop + 0.1), "main", "s03_robot_stopped_main"], [q(t_stop + 0.8), "screen_close", "s04_robot_stopped_close"], [q(on2["H2"] + 0.8), "screen_close", "s07_toorimasu"], [q(t_man0 + 0.5 * MAN_T), "main", "s09_shift_main"], [q(t_man0 + 0.5 * MAN_T), "top", "s09_shift_top"], [q(t_resume + 2.5), "main", "s10_pass_main"], [q(t_oturn1 + 0.3), "chk_grip", "chk_grip_turned"], [q(t_man0 + 1.0), "chk_grip", "chk_grip_man"]] if stuck: stills += [[q(t30 + 0.5), "screen_close", "s08_toremasen"], [q(t30 + 1.5), "main", "s08_stuck_label"], [q(on2["M4"] + 0.8), "morita_face", "s11_morita_matasare"], [q(happy_from + 0.5), "screen_close", "s13_arigato_happy"], [q(happy_from + 0.5), "main", "s13_arigato_main"]] else: stills += [[q(on2["V8"] + 0.4), "oshiro_face", "s08_oshiro_notices"], [q(on2["M2"] + 1.0), "morita_face", "s11_morita_tooru"], [q(on2["M3"] + 0.6), "main", "s12_morita_nanida"], [q(on2["H3"] + 0.6), "screen_close", "s13_otodokechu"], [q(happy_from + 0.5), "screen_close", "s13_arigato_happy"], [q(happy_from + 0.5), "main", "s13_arigato_main"]] # 早回し(⑨-2:声と動きの無い所。×4) ff = [] if stuck: # 依頼237:10〜20 秒の間(235 のまま)と、6(ハコブ「はい、お待ちしています」)のあとから 30 秒の手前まで。5・6 は 1 倍 ff = [[round(on2["H2"] + 3.4, 3), round(on2["H2b"] - 0.6, 3)], [round(max(endH4, m_back1) + 0.6, 3), round(t30 - 0.6, 3)]] ff = [[a, b] for a, b in ff if b - a >= 1.0] shot = {"name": variant, "about": "⑨ 車いすが廊下の真ん中で止まる(依頼237:" + ("⑨-2 立ち往生になる" if stuck else "⑨-1 声をかけて通る") + ")", "origin": O, "duration": DUR, "video": True, "box_start": {"on": "hidden"}, "robot": {"screen": [[0, "face"]]}, "box_events": [], "card_events": [], "presses": [], "card": False, "check_open": [], "check_close": [], "check_above": [], "transitions": [], "robot_start_z": RZ0, "swing_ramp": 0.15, "lift_pow": 0.5, "nurse": {"x": keys_x, "z": keys_z, "yaw": keys_yaw, "walk": walk, "spine": spine, "chest": chest, "head_yaw": hy, "head_nod": hn, "mouth": mouth_o, "talk": talk_o, "L_w": [[0, 1.0]], "R_w": R_w, "L_target": L_target, "R_target": R_target, "L_curl": [[0, 30.0]], "R_curl": R_curl, "L_thumb": [[0, 20.0]], "R_thumb": [[0, 20.0]], "L_hint": [[0, "push_l"]], "R_hint": [[0, "push_r"]], "L_hint_w": [[0, 0.5]], "R_hint_w": [[0, 0.5]]}, "steps": steps, "look_windows": [], "cameras": CAM, "cuts": cuts, "stills": stills, "c237": {"wc_ahead_m": round(WC_AHEAD, 4), "video_from": TV0, "video_to": round((NF - 1) * DT, 4), "chair": chair_rows, "grip_both": [1 if g else 0 for g in grip_both], "screen": scr, "ring": ring, "ring_wait_color": "#F2C230", "happy": [round(happy_from, 4), round(happy_to, 4)], "beside_used": [round(bs[0], 4), round(bs[1], 4)], "h3_arigato_s": round(H3_ARIGATO, 4), "stuck_label": [round(t30, 4), round(t30 + 3.0, 4)] if stuck else None, "ff": ff, "ff_speed": 4, "robot_mouth": robot_mouth, "nurse_mouth": nurse_mouth, "tera_mouth": tera_mouth, "morita_mouth_lvl": mor_mouth, "nurse_mouth_scale": [1.0, 1.2, 1.8, 2.4], "morita": {"head_yaw": m_yaw, "head_nod": m_nod, "mouth": m_mouth, "neck_share": 0.4, "blink": {"every_min_s": 3.0, "every_max_s": 5.0, "close_s": 0.15, "seed": 228}, "eye_min_scale": 0.1}, "lines": place, "grip": {"x": GRIP_X, "y": GRIP_Y, "z_behind_root": GRIP_Z, "r": GRIP_R}, "man": {"t0": round(t_man0, 4), "t1": round(t_man1, 4), "path_file": os.path.basename(pathjs), "segs": P["segs"], "v_max": V_MAX, "w_max": W_MAX}, "tera_ret": {"x": xr, "z": round(zr, 4), "from": [round(T_X, 4), round(z_tstop, 4)], "t": [round(t_tr0, 4), round(t_tr3, 4)]}, "times": {k: (round(v, 4) if isinstance(v, float) else v) for k, v in ev.items()}}} tshot = {"name": variant + "__tera", "about": "寺島さん(" + variant + ")", "origin": O, "duration": DUR, "video": True, "box_start": {"on": "hidden"}, "robot": {"screen": [[0, "face"]]}, "box_events": [], "card_events": [], "presses": [], "card": False, "check_open": [], "check_close": [], "check_above": [], "transitions": [], "swing_ramp": 0.15, "lift_pow": 0.5, "nurse": {"x": tx_, "z": tz_, "yaw": ty_, "walk": t_walk, "spine": [[0, 2.0]], "chest": [[0, 1.0]], "head_yaw": thy, "head_nod": thn, "mouth": mouth_t, "talk": talk_t, "L_w": [[0, 0.0]], "R_w": [[0, 0.0]]}, "steps": t_steps} info = {"variant": variant, "duration": DUR, "t_stop": t_stop, "happy": [round(happy_from, 3), round(happy_to, 3)], "beside": [round(bs[0], 3), round(bs[1], 3)], "on": {k: round(v, 3) for k, v in on2.items()}, "man": [round(t_man0, 3), round(t_man1, 3), round(MAN_T, 3)], "stuck_est": round(t_resume_est - t_stop, 3), "t_tr": [round(t_tr0, 3), round(t_tr3, 3)], "ff": ff} return shot, tshot, info out = {k: S[k] for k in ("fps", "width", "height", "supersample", "colors", "light", "rooms", "box", "bag", "nurse", "targets", "card", "pocket", "screen_ui", "drawer_parts", "hints", "check_stand_parts", "corridor")} out["about"] = "依頼237:⑨ 車いすが廊下の真ん中で止まる(場面 stop_voice・stop_stuck、寺島さんは __tera)。make_script237.py(make_script235.py の写し)が作った。廊下・色・光・看護師・画面の値は 175 の台本から写した" out["nurse"] = dict(out["nurse"]); out["nurse"]["walk"] = dict(out["nurse"]["walk"]) out["nurse"]["walk"].update({"amp_deg": 11.0, "knee_deg": 24, "bob_m": 0.008, "lift_m": 0.05}) gz = WC_AHEAD - GRIP_Z out["targets"] = dict(out["targets"]) py = GRIP_Y + GRIP_R + 0.018 out["targets"]["grip_l"] = {"ref": "nurse", "pos": [round(-GRIP_X, 4), round(py, 4), round(gz - 0.05, 4)], "finger_frame": "nurse", "finger": [-1.0, -0.35, 1], "palm_frame": "nurse", "palm": [0.3, -1, 0.0]} out["targets"]["grip_r"] = {"ref": "nurse", "pos": [round(GRIP_X, 4), round(py, 4), round(gz - 0.05, 4)], "finger_frame": "nurse", "finger": [1.0, -0.35, 1], "palm_frame": "nurse", "palm": [-0.3, -1, 0.0]} # 振り返る間の左手:止まった時(大城さんの根 x 0・z Z_NS・向き 180°)の grip_l と同じ点・同じ向きを、世界に止める out["targets"]["grip_r_up"] = {"ref": "nurse", "pos": [round(GRIP_X + 0.03, 4), round(py + 0.15, 4), round(gz - 0.20, 4)], "finger_frame": "nurse", "finger": [1.0, -0.35, 1], "palm_frame": "nurse", "palm": [-0.3, -1, 0.0]} out["targets"]["grip_l_w"] = {"ref": "world", "pos": [round(GRIP_X, 4), round(py, 4), round(Z_NS - (gz - 0.05), 4)], "finger_frame": "world", "finger": [1.0, -0.35, -1], "palm_frame": "world", "palm": [-0.3, -1, 0.0]} out["hints"] = dict(out["hints"]); out["hints"]["push_l"] = [-0.40, 1.0, -0.20]; out["hints"]["push_r"] = [0.40, 1.0, -0.20] out["robot_rule"] = RULE shots, infos = [], [] for v in ("stop_voice", "stop_stuck"): a, b, i = build(v); shots += [a, b]; infos.append(i) out["shots"] = shots out["c237_common"] = {"z_ns": Z_NS, "t_ns": round(t_ns, 4), "t_v1": round(t_v1, 4), "nz0": NZ0, "tz0": round(TZ0, 4), "t_x": round(T_X, 4), "t_dz": T_DZ, "o_turn": O_TURN, "z_tstop": round(z_tstop, 4), "t_ts": round(t_ts, 4), "yaw_face_o": round(YAW_FACE_O, 3), "man_T": round(MAN_T, 3), "t_stop_used": t_stop, "robot_stop_z_used": z_rstop} json.dump(out, open(dst, "w"), ensure_ascii=False, indent=0) print(json.dumps({"common": out["c237_common"], "shots": infos}, ensure_ascii=False))