# 機器人系列原理動畫(第 b 批)

檔案:`resources/js/anim-robot-b.js`(匯出 `ROBOT_ANIMS_B`,已併入 `ANIMS`)。畫面只取決於時間 t,可暫停/拖曳/倒轉。字幕時間軸請以下列「逐秒時間軸」為準(預設參數下)。
測試:`node tools/test-anim-robot-b.mjs`;翻譯:`lang/_work/anim-robot-b.json`。

---

## color-threshold — 顏色閾值
一句話:影像 → HSV 閾值 → 二值遮罩 → 最大輪廓 → 質心與水平偏移(轉向)。duration 14。
params:`hue` 0~359(預設 120)、`tol` 8~60(預設 25)。
- 0–3:原始 20×12 影像(RGB);1.5 起框出一格並顯示 RGB→HSV 數值
- 3–6:由左往右掃成色相圖,右側色相條與範圍 H±tol;要求 S≥0.35、V≥0.25(高光被濾掉)
- 6–9:掃成二值遮罩,顯示白色像素數
- 9–11.5:標出各連通區域與面積,金框 = 最大者,其餘(雜訊、小塊)紅框
- 11.5–14:只留最大塊;畫面中心線、質心十字、dx 箭頭;顯示 dx、steer = dx÷10 與「偏右/偏左/直行」
建議:樹莓派版 ch07(顏色追蹤);Arduino 版 ch08(ESP32-CAM 顏色追蹤)。

## conv-kernel — 卷積核滑動
3×3 核在 8×8 影像上滑動,逐格算出 6×6 輸出。duration 14。params:`kernel` 0 邊緣/1 模糊/2 銳化(預設 0)。
- 0–2:顯示輸入、核與空的輸出格
- 2–12:視窗每 ~0.28 秒移一格(36 格,列優先),顯示視窗 3×3、Σ 與結果(限制 0~255)
- 12–14:輸出完成,說明效果(邊緣/平滑/銳利)
建議:樹莓派版 ch07;ROS 2 版 ch08;(CNN 前置)。

## detect-boxes — 物件偵測、IoU、NMS
duration 16。params:`threshold`(NMS 的 IoU 門檻)0.1~0.9(預設 0.5);信心分數門檻固定 0.25。
- 0–2:影像有兩個杯子
- 2–4:7 個候選框依序出現(每 0.28 秒一個)並標分數
- 4–6:分數 < 0.25 的兩框變暗(「分數太低」)
- 6–7:IoU 概念,A1/A2 交集塗色,IoU = 0.73
- 7–13:NMS 逐輪(預設 2 輪,每輪 3 秒):第 1 輪挑 A1,抑制 A2、A3;第 2 輪挑 B1,抑制 B2;右下顯示各 IoU
- 13–16:只剩 A1、B1;門檻過高/過低時有警語
建議:樹莓派版 ch07;ROS 2 版 ch08。

## cnn-layers — CNN 概念流程
duration 14。params:`cls` 0 貓/1 狗/2 鳥(預設 0,決定最高機率類別)。全程標示「概念示意,非特定模型」。
- 0–2.4 輸入影像;2.4–4.9 卷積+ReLU(3 張特徵圖);4.9–6.9 池化;6.9–8.4 展平(48 個數);8.4–10 全連接;10–10.5 輸出節點;10.5–13 機率長條成長(92/5/3%);13–14 總和 = 100%
建議:樹莓派版 ch07;ROS 2 版 ch08;Arduino 版 ch08(TinyML 概念)。

## llm-safety-gate — LLM 安全閘門
duration 16。params:`vmax` 速度上限 0.2~2(預設 0.5 m/s)。三個動作:move 0.3、move 1.5、format_disk;結果由 `gateCheck` 實算(改 vmax 會改變通過/拒絕)。
- 0–2:流程圖(指令→LLM→白名單→範圍→人工確認→執行器),LLM 只能建議
- 2–5.6 動作 1(v=0.3):逐關通過;約 4.2–4.8 等人工確認,4.5 起顯示已確認;5.3 起馬達運轉
- 5.6–9.2 動作 2(v=1.5):約 7.25 在範圍檢查被擋(紅 X),8.0–8.8 退回 LLM
- 9.2–12.8 動作 3(format_disk):約 10.3 在白名單被擋,11.6–12.4 退回
- 12.8–16:急停(13.4 起按下),紅色獨立旁路直達馬達,馬達斷電
建議:樹莓派版 ch08;Arduino 版 ch09;ROS 2 版 ch09;手臂版 ch09。

## camera-pinhole — 針孔成像
duration 14。params:`dist` 物距 1~5 m(預設 2)。f=4 mm、物高 1 m、像素 3 µm。
- 0–2:物體、針孔、感光元件
- 2–5:上下端光線穿過針孔,4.6 起出現倒立像;h'=f·H÷d
- 5–7.5:物體移遠(d→2×,最多 6 m),像變小;7.5–8.5 停留
- 8.5–11:移近(d→½,最小 0.8 m),像變大
- 11–14:右側畸變(桶狀)網格,說明與距離無關、需棋盤格標定
建議:樹莓派版 ch07;手臂版 ch08。

## ros-pubsub — ROS 2 四種通訊
duration 16。params:`qos` 0 可靠/1 盡力(預設 0,僅概念)。四個區塊輪流高亮。
- 0–4.5 話題:發布者每 0.85 秒送訊息,廣播給 2 個訂閱者;約 2.9 秒訂閱者 2 的那筆掉包(可靠→重送、盡力→遺失)
- 4.5–8.5 服務:0.2–1.2 請求(a=1,b=2);1.2–2.4 處理中;2.4–3.4 回應(sum=3),期間客戶端「被卡住」
- 8.5–13.5 動作:0.2–1 送目標;1–1.5 已接受;1.6 起每 0.7 秒回報 25/50/75/100%;4.2–4.9 結果
- 13.5–16 比較表:感測串流→話題、查詢→服務、耗時任務→動作;QoS 僅概念
建議:ROS 2 版 ch02。

## tf-frames — 座標系與 TF 樹
duration 16。params:`yaw` base_link 偏航 −180~180°(預設 30)。P 固定在 map (4, 2.5)。
- 0–2 map;2–4 odom(平移 (0.5,0.3)+旋轉 15°);4–6 base_link(機器人);6–8 laser、camera(相對 base_link 的平移與角度)
- 8–12:點 P 出現,依序顯示 map、odom、base_link、laser、camera 下的座標(8.5 起每 0.8 秒一列)
- 12–14.5:機器人再轉 45°,map/odom 數字不變,車上三組改變;至 16 保持
建議:ROS 2 版 ch04。

## slam-mapping — SLAM 建圖
duration 16。params:`drift` 里程計漂移 0~1(預設 0.6)。
- 0–1.5:全未知;1.5–10:機器人繞中央障礙一圈,24 束光達,空閒/占用逐步建立,金線(估計)逐漸偏離綠虛線(真實)
- 10–11.5:回到起點,認出來過 → 迴圈閉合,顯示累積誤差
- 11.5–14:誤差分攤回軌跡,地圖重影消失
- 14–16:修正後地圖一致
建議:ROS 2 版 ch06。

## astar-path — A* 搜尋
duration 16。params:`w` 啟發權重 0~3(預設 1;f=g+w·h,w=0 即 Dijkstra,w>1 不保證最短)。4 鄰域、曼哈頓距離。
- 0–2 地圖;2–8 逐步展開(藍=封閉、綠=開放、金框=目前節點與 g/h/f);8–9.5 回溯畫出路徑(預設 23 步)
- 9.5–10.5 機器人走 3 格;10.5 起前方出現新障礙(紅,閃爍)
- 10.5–11.5 路徑被擋;11.5–14.5 從機器人位置重新搜尋;14.5–16 畫出新路徑(預設 20 步)
建議:樹莓派版 ch09;ROS 2 版 ch07。

## costmap-avoid — 代價地圖與避障
duration 16。params:`infl` 膨脹半徑 0.5~1.2 m(預設 0.8)。1 格 = 0.2 m,機器人半徑 0.2 m,cost = 252·e^(−3(d−r))。
- 0–2 障礙;2–5 膨脹逐漸長出(粉=內切圈 253、橘=膨脹區);5–7.5 全域路徑(Dijkstra 於代價地圖)畫出
- 7.5–:機器人沿路徑前進,局部地圖框跟隨;8 起行人迎面走來(虛線圈=膨脹半徑)
- 約 9–13:機器人偏離路徑繞開行人,維持膨脹半徑外;之後回到路徑,15.5 抵達
建議:ROS 2 版 ch07。

## two-link-fk — 兩連桿正向運動學
duration 14。params:`th1` −90~180°(預設 40)、`th2` −150~150°(預設 60)。L1=14、L2=11 cm。
- 0–2 連桿伸直;2–5 轉 θ1;5–8 轉 θ2(從 L1 延長線量起)
- 8–12:向量 v1、v2、v1+v2 依序畫出(8–9.2 / 9–10.2 / 10.2–11.5),右側逐行代入 x、y 數值;10.6 起虛線投影
- 12–14:顯示末端 (x, y)=(8.81, 19.83)
建議:手臂版 ch04。

## two-link-ik — 兩連桿逆向運動學
duration 16。params:`x` −25~25(預設 14)、`y` −12~25(預設 12)。
- 0–2 目標與可達環;2–4 以底座為心、半徑 L1 的圓;4–5.5 以目標為心、半徑 L2 的圓
- 5.5–7 兩圓交點 = 兩個肘(不可達時無交點與提示);7–10 解 1 肘下(餘弦定理 cosθ2、θ2、θ1);10–13 解 2 肘上
- 13–15.5 目標向外移出可達範圍,手臂伸直指向它,顯示「無解」
建議:手臂版 ch05。

## trapezoid-profile — 梯形速度曲線
duration 10。params:`vmax` 20~90 °/s(預設 45)、`amax` 10~90 °/s²(預設 30);位移 180°。
- 0–1.5 說明限制;1.5–8.5 慢動作播放整條曲線(預設:加速 1.5 s、等速 2.5 s、減速 1.5 s,共 5.5 s),速度與位置圖同步、手臂轉動、底色綠/藍/紅分段(預設比例:約 1.5–3.1 秒加速、3.1–5.9 等速、5.9–8.5 減速)
- 8.5–10:面積 = 位移 180°;距離短時退化為三角形(提示峰值 < vmax)
建議:手臂版 ch06。

## grip-friction — 夾持力與摩擦力
duration 12。params:`mu` 0.1~1.2(預設 0.5)、`force` 每指夾持力 1~20 N(預設 6)。物體 0.5 kg,mg=4.9 N,抓得住條件 2μN ≥ mg。
- 0.2–1.2 重力 mg;1.5–3 手指靠近;3–4.5 正向力 N 箭頭成長,顯示 f_max、2f_max vs mg
- 4.5–6.5 提起:抓得住則物體跟著升,摩擦箭頭 = mg/2;抓不住則手指滑走、物體留在桌上
- 6.5–8.5 結論;並出現 N–力圖(2μN 直線、mg 水平線、交點 N_min=4.9)
- 8.5–12:N 游標由 0 掃到 20 N,即時顯示抓得住/抓不住
建議:手臂版 ch07。

## hand-eye — 手眼校正(單應性)
duration 16。params:`noise` 像素偵測雜訊 0~6 px(預設 1.5)。
- 0–2:相機影像(透視梯形)與桌面平面
- 2–6:4 個標定點依序(每 1 秒)在兩邊標出並連線,列出像素→毫米
- 6–8.5:顯示 8 方程 8 未知、矩陣 H 與 [X Y 1]ᵀ ∝ H·[u v 1]ᵀ
- 8.5–12:桌面格線以 H⁻¹ 投影回影像(金線)
- 12–16:新物體像素 → 換算(金十字)vs 真實(綠圈),紅箭頭(放大 12 倍)與誤差數值;14.5 起列出誤差來源(像素偵測、畸變、標定點量測、物體高度)
建議:手臂版 ch08、ch10。

---

## 已知限制
- 示意性質:ROS 2 QoS、Nav2 代價地圖/局部規劃、SLAM 迴圈閉合(線性分攤)、CNN 皆為概念簡化,畫面內有標註。
- 手眼校正只模擬像素雜訊,不模擬畸變與高度,僅文字列出。
- A* 權重 > 1 時不保證最短,畫面有提示。
