# 第二階段：支撐分配、參考限速與接觸診斷

這一輪沿用固定羽生骨架、57 kg、原本冰刀幾何與摩擦 profile。
原「姿態 + 平衡回授」保留；新「支撐力分配＋重心回授」是可比較的候選，
不是已通過的推蹬技能。沒有把參考骨架的位置或速度寫入浮動根。

## 使用方式

在[機器人實驗](../robot-study.html)選擇「支撐力分配＋重心回授 · 候選」，
480 Hz、初速 0、100% 強度，按「重設」「開始」。先使用「移重＋轉刀」，
再以「完整推蹬」檢查失敗；完整推蹬仍可能跌倒，不能當成已可用的推進指令。
畫面另顯示支撐分配的合力／合力矩殘差與正在限制的關節目標數量。
這些殘差是目標分配的可行性，不是實際接觸力誤差。

[姿態對照](stroke-study.html)新增「依關節速度上限調整播放時間」。
來源時碼保持原樣，只改播放時序，方便查看原始與限速後的差異。

## 控制層

1. 從身體質心、姿態、實際速度與預測可接觸冰刀建立支撐需求。
2. 在冰刀縱、橫方向的摩擦限制內，求解兩腳目標力，使合力及質心周圍合力矩
   接近需求。採用內接摩擦金字塔；不可達的目標保留殘差，不假設一定可實現。
3. 用接觸點 Jacobian 的轉置把支撐需求轉成關節力矩。只有關節致動器輸出；
   真正的冰刀接觸、承重、滑移與根節點運動仍由 MuJoCo 求出。
4. 推伸與回收候選另以「質心相對支撐點」的 Jacobian 修正橫向姿態。
   倒單擺的質心／速度估計只是近似，不等於多接觸、低摩擦滑冰的平衡證明。
5. 關節目標每步不超過 profile 速度上限的 80%。這限制的是目標，
   不是保證實際關節速度、加速度、功率或接觸力一定可行。
6. 支撐分配殘差持續過大時中止。中止只是轉入嘗試回正，並不保證成功救回。

支撐預測可以包含幾何上接近冰面的刀；它與實測負重分開保留。
固定迭代分配器沒有完整 QP 最適性或全身逆動力學保證。
較小的力分配殘差也不能代表接觸模型已驗證。

## 接觸診斷的新證據

- [共同初始狀態、240–1920 Hz](reports/contact-resolution-development.json)：
  端點位置差縮小，但原始承重切換序列仍不一致；未放寬原本驗證門檻。
- [摩擦隔離](reports/contact-friction-isolation.json)：同一受限冰刀 fixture，
  無摩擦設定在 240／480 Hz 各一秒測試均無零承重步。
  加入等向或原本方向性摩擦後，均出現 76／140 個零承重步。
  這支持繼續調查切向摩擦與法向軟接觸耦合，尚不等於已定位引擎缺陷。
- [法向／耗散摩擦分離候選](reports/decoupled-friction-development.json)：
  法向仍由引擎求解；切向採用實際負重與滑速的平滑耗散力。
  240／480 Hz 的四組方向／朝向比較都沒有承重切換，最大終點位置差約 2.11 mm，
  觀察到的機械能增加為零。這只是受限 fixture，沒有整合進全身 robot。

分離候選尚缺靜摩擦、低速抓刃、彎刀接觸、刀齒、自由身體與 WASM 的驗證。
平滑摩擦在零速度時不提供精確的靜摩擦，不能直接假設它能維持單腳抓冰。
也尚未建立完整順應性接觸儲能帳，因此不能宣布 P1 通過。

引擎依據：[MuJoCo 接觸與求解器](https://mujoco.readthedocs.io/en/stable/modeling.html#solver-parameters)、
[Jacobian API](https://mujoco.readthedocs.io/en/stable/APIreference/APIfunctions.html#mj-jacsubtreecom)。

## 測試與限制

[分配器與限速檢查](reports/support-component-checks.json)涵蓋對稱平衡、90° 朝向共變、
摩擦邊界、離冰時零支撐、不可行殘差及限速。原參考峰值為上限 1.275 倍；
逐段重排後不超過 0.8 倍。分段線性時序仍有速度接縫，下一步需加速度／力矩可行的時間規劃。

[全身對照](reports/support-stage2.json)保留舊／新控制器、不同強度、朝向、冰面、步頻與擾動。
結果必須區分入刃條件達成、參考進入卸重、真正完成回收接冰及跌倒。
最終 11 組案例的結果：站立、移重轉刀、小幅側向擾動均持續 35 秒。
移重轉刀後，第 12 秒起的速度峰值由舊版 0.0636 m/s 降至 0.0347 m/s；
第 35 秒速度由 0.00935 m/s 降至約 0.000008 m/s。這是指定案例的晃動減少，
不代表整體恢復能力已通過。

100% 完整推蹬由推伸進入卸重，但仍在第 13.017 秒跌倒（指令於第 3 秒開始）。
沿前進方向淨位移為 −0.0238 m，沒有成功推進證據；240 Hz／90° 朝向也仍跌倒。
25%／50% 強度因入刃條件未達成而逾時中止，35 秒未跌倒，也不等於完成推蹬。
橫向抓地減半的案例中止後未跌倒，不能因此把低摩擦宣布為更好的物理模型。
失敗案例的力矩變化率與關節界線殘差保留，不以目標限速取代實測限制。
Checkpoint 重播差為 0；關節目標速度最大為設定上限的 0.8 倍。

這組案例是在開發後選定的回歸矩陣，不是未參與選模的獨立驗證集。
歷次調參診斷 JSON 僅為開發過程紀錄；完整可重跑版本以最終報告的輸入 hash 為準。

## 雙腳直滑優先

使用者回報「有初速時三秒內前傾跌倒」，重現後暫緩交替支撐與完整推蹬，先隔離雙腳平行前滑。
新模式 `glide` 保留固定身材、冰刀、摩擦 profile、力矩／功率／變化率限制與原始接觸；舊 `balance`、`wrench` 不變。

初速 1／2 m/s 時，舊 `balance` 分別在 2.371／1.450 秒跌倒，`wrench` 分別在 1.356／0.950 秒跌倒。
前者已有阻力感知的支撐力矩，但關節目標仍是靜止站姿；後者更要求縱向接觸力為零，作用點也沒有阻力補償。
冰面阻力在質心下方作用，會帶來前傾力矩。新模式沿用前者的接觸力前饋，再補上相容的雙踝姿態：

```text
u = μ_longitudinal × tanh(v_forward / 0.08)
CoP_forward = COM_forward + 0.1 × pitch + 0.05 × pitchRate + u × COM_height
ankleTarget += -0.4 × pitch - 0.12 × pitchRate - atan(u)
```

這是已知平面冰面、理想感測下的控制近似。速度接近零時補償逐漸消失，後滑則反向。
不固定根節點、不鎖冰刀、不持續寫入滑速、不向根節點施加控制力。
自然減速與關節功仍由引擎計算，故「直滑」不是定速前進，也不能作為成功推蹬的證據。

[本次逐案報告](reports/straight-glide.json)包含速度、朝向、步頻、橫向抓地減半與小幅擾動；
記錄跌倒、俯仰、側傾、骨盆高度、力矩限制、接觸零承重步及 checkpoint 重播。
完整 trace 與修改前結果保存在 repo 的 `verification/ice/robot/straight-glide-results.json`、`straight-glide-baseline.json`。
這些是開發回歸測試，不是獨立量測或已通過完整 P1／P3。

480 Hz 的 12 組案例全部完成 20 秒；1／2／3 m/s 初速分別沿前方移動約 1.686／6.783／15.275 m 後停穩。
所有 480 Hz 案例最大前後傾約 1.38°，沒有關節界線超限，力矩變化率比不超過 1，
實測關節速度亦未超過設定上限。Checkpoint 的物理狀態、控制器、接觸及作功帳重播完全一致。
240 Hz 的 1／2／3 m/s 案例仍在 1.48／0.91／0.62 秒跌倒，不能視為已支援的直滑設定。
480 Hz 也仍有短暫零承重步；改善平衡不等於接觸收斂通過。


另外，舊「轉刀」通過門檻只有 1.43°，實際右刀相對骨盆約 2°，在畫面投影約僅 1.45 px 差異。
重定向後髖 yaw 增量又乘以 0.35，其變化比膝、髖 roll 與踝 roll 更小，因此主要看到移重。
現已改名「移重＋小角度刀向試驗」，顯示實際雙刀方向，不再把這項門檻稱為入刃成功。

### 下一個轉刀驗證的目標

依使用者指定，本次前進推蹬的有效刀向目標改為相對身體前方 **45–60°**。
這是本專案選定的推蹬試驗範圍，不是所有滑冰動作共用的固定角度。
角度由實際刀跟 → 刀尖向量在冰面投影，對骨盆前方計算；不能以髖關節 yaw 或離線參考角代替。
右腳外轉目標為 −45° 到 −60°，左腳對稱；左右正負號依本專案左正右負的平面方向定義。

直滑是本輪優先項目，45–60° 尚未接入動力學動作。後續順序：

1. 用固定骨長與既有關節界線解算 45／52.5／60° 的足部目標，先檢查髖、膝、踝、自由腳淨空與接觸可行性。
2. 維持支撐腳平衡，分段規劃推蹬腳負重與刀向變化；避免把全身站姿直接疊加大角度。
3. 實際刀向進入指定範圍後，仍須檢查承重刃、法向力、滑移及能力限制，才嘗試向右後方推伸。
4. 與同初速、同冰面、無推蹬的直滑比較正向動量與關節功，再檢查卸重、回收接冰。

既有約 2° 的候選保留作對照，不上調成功名稱、不把角度門檻的調整當作已完成 45–60°。

## 下一階段順序

0. 先以雙腳直滑隔離前後向平衡：不同初速、朝向與擾動；確定步長與接觸限制，再恢復單腳承重研究。


1. 在獨立接觸 fixture 完成法向／切向分離候選的靜摩擦與低速抓地設計，
   加入自由刀體及 Native／WASM 對照，再決定是否整合；保留原接觸模式。
2. 把重定向姿態轉成包含質心、腳底位置與接觸力的動態可行計畫，
   同時限制加速度、關節力矩與功率。不能只靠獨立關節增量追蹤。
3. 分別通過推伸、卸重、回收、接冰和中止恢復，再串成一次推蹬。
   只有產生可歸因於關節功的正向動量、維持接觸與能力限制，才討論連續推進。

## 重現

於 repo 根目錄執行：

```powershell
node verification/ice/robot/verify-support-wrench.mjs
node verification/ice/robot/verify-support-stage2.mjs
.venv-robot/Scripts/python.exe -X utf8 verification/ice/robot/diagnose-contact-resolution.py
.venv-robot/Scripts/python.exe -X utf8 verification/ice/robot/diagnose-contact-friction.py
.venv-robot/Scripts/python.exe -X utf8 verification/ice/robot/diagnose-decoupled-friction.py
```

本頁是開發紀錄；產生報告不代表 commit、push 或發佈。
