{
 "byKey": {
  "cover": [
   { "say": "大家好,歡迎回到從無到有打造 A I 機器人。這一章我們要學怎麼控制機器人:cmd vel 速度指令、差速運動學、遙控與限速看門狗,最後還有用 rosbag 錄製資料。", "item": 0 }
  ],
  "原理:差速運動學、里程計與回授控制#1": [
   { "say": "先從一個生活的例子開始,蒙眼走直線。", "item": 0 },
   { "say": "請朋友蒙上眼睛,要他走五公尺回到原處。如果他只靠數步數,走久了一定歪掉,因為每一步的長度和方向都有誤差。如果旁邊有人隨時喊偏左了,他就能修正。", "item": 1 },
   { "say": "前者就是里程計,靠輪子轉的圈數推算位置;後者就是回授控制,靠量測的結果去修正命令。", "item": 1 }
  ],
  "原理:差速運動學、里程計與回授控制#2": [
   { "say": "差速驅動,兩個輪子決定一切。", "item": 0 },
   { "say": "左右輪各自的線速度,我們叫它 vL 和 vR,決定整台車的運動。前進速度 v 等於右輪加左輪,再除以二,也就是兩輪的平均。角速度 omega 等於右輪減左輪,再除以 L,L 是兩輪中心的距離。", "item": 1 },
   { "say": "為什麼?兩輪同速,車子直走;右輪比較快,車身繞著速度較慢的一側轉,所以是左轉。反過來,如果要 v 和 omega,就給右輪 v 加 omega 乘 L 除以二,左輪 v 減 omega 乘 L 除以二。", "item": 1 }
  ],
  "原理:差速運動學、里程計與回授控制#3": [
   { "say": "編碼器的功能,是把轉動變成距離。", "item": 0 },
   { "say": "假設輪半徑是零點零三三公尺,輪周長就是二 pi r,大約零點二零七三公尺。編碼器每轉一圈輸出一千個脈衝,這只是舉例,實際依零件。", "item": 1 },
   { "say": "數到五百個脈衝,代表輪子轉了半圈,走了大約零點一零三七公尺。兩個輪子各自的位移算出來之後,取平均就是車子的前進量,右輪減左輪再除以兩輪距離,就是轉角。", "item": 1 }
  ],
  "原理:差速運動學、里程計與回授控制#4": [
   { "say": "里程計的做法,就是把小步累加起來。", "item": 0 },
   { "say": "每個時間步,x 加上 v 乘 cos theta 乘時間,y 加上 v 乘 sin theta 乘時間,theta 加上 omega 乘時間。", "item": 1 },
   { "say": "我們用數字試試看。速度零點二、角速度零點五,每步零點五秒,走四步共兩秒。下一頁會列出每一步的結果。精確解是半徑零點四公尺的圓弧,兩秒後 x 約零點三三七,y 約零點一八四。", "item": 2 }
  ],
  "原理:差速運動學、里程計與回授控制#5": [
   { "say": "這是每一步算出來的結果。", "item": 0 },
   { "say": "第一步,x 是零點一,y 是零,角度零點二五弧度。", "item": 1 },
   { "say": "第二步,x 約零點一九七,y 約零點零二五,角度零點五。", "item": 2 },
   { "say": "第三步,x 約零點二八五,y 約零點零七三,角度零點七五。", "item": 3 },
   { "say": "第四步,x 約零點三五八,y 約零點一四一,角度一弧度。跟精確解比起來有差距,這就是離散積分的誤差,步長越小越準。", "item": 4 }
  ],
  "原理:差速運動學、里程計與回授控制#6": [
   { "say": "我們來看里程計積分示意圖。", "item": 0 },
   { "say": "圖中藍色折線,是每步零點五秒的離散積分;綠色虛線是精確的圓弧。兩條線從同一個起點出發,終點略有差異。實機還有輪徑不準、打滑的誤差,而且會隨距離累積,所以長時間導航要靠定位來修正。", "item": 1 }
  ],
  "原理:差速運動學、里程計與回授控制#7": [
   { "say": "最後是回授控制,流程是量測、比較、修正。", "item": 0 },
   { "say": "圖中的方塊圖是這樣:目標和量測相減得到誤差,控制器依誤差產生命令給馬達與底盤,編碼器的量測再回到比較點。最簡單的比例控制,命令等於 Kp 乘以誤差,誤差是目標減量測。", "item": 1 },
   { "say": "舉例,目標速度零點二,假設每一步的效果是往目標前進一半。從零開始,速度依序是零點一、零點一五、零點一七五、零點一八七五,逐步逼近零點二,但永遠有一點誤差。", "item": 1 },
   { "say": "增益太小,反應慢;太大,會過衝甚至振盪。實機的馬達有慣性延遲,所以增益要實際測試調整。", "item": 1 }
  ],
  "cmd_vel 與差速運動學:速度怎麼變成輪子轉動#1": [
   { "say": "好,接下來看 cmd vel,它是移動機器人的通用語言。", "item": 0 },
   { "say": "幾乎所有輪式機器人在 R O S 二,都接受同一種速度指令:發布 Twist 訊息到 cmd vel 這個 topic。Twist 有兩組向量,但對平面上的差速機器人,只用兩個數。", "item": 0 },
   { "say": "第一個是 linear x,前進速度,單位是每秒公尺,正值往前,就是車頭方向。", "item": 1 },
   { "say": "第二個是 angular z,轉動速度,單位是每秒弧度,正值是逆時針,從上往下看就是左轉。其他欄位差速車用不到,維持零。座標慣例是 x 向前、y 向左、z 向上。", "item": 2 },
   { "say": "好處是,不管底盤是兩輪、四輪還是履帶,上層的遙控、Nav 二、你的 A I node,都只要會發 cmd vel。注意版本差異,新版本有時改用 TwistStamped,多一個 header。請以 topic info 顯示的型別為準,不要假設。", "item": 2 }
  ],
  "cmd_vel 與差速運動學:速度怎麼變成輪子轉動#2": [
   { "say": "我們再回到差速驅動運動學。", "item": 0 },
   { "say": "兩個輪子的中心距是 L,也叫軸距,左右輪線速度是 vL 和 vR。前進速度 v 是兩輪平均;角速度 omega 是右輪減左輪再除以 L,右輪較快就左轉。", "item": 1 },
   { "say": "反過來,已知 v 和 omega,右輪速度等於 v 加 omega 乘 L 除以二,左輪速度等於 v 減 omega 乘 L 除以二。", "item": 2 }
  ],
  "cmd_vel 與差速運動學:速度怎麼變成輪子轉動#3": [
   { "say": "把四個公式整理在一起。", "item": 0 },
   { "say": "前進速度 v,是兩輪速度平均。", "item": 1 },
   { "say": "角速度 omega,是右輪減左輪,再除以 L。右輪較快就左轉。", "item": 2 },
   { "say": "已知 v 和 omega 時,右輪是 v 加 omega 乘 L 除以二。", "item": 3 },
   { "say": "左輪是 v 減 omega 乘 L 除以二。", "item": 4 }
  ],
  "cmd_vel 與差速運動學:速度怎麼變成輪子轉動#4": [
   { "say": "這是差速驅動的幾何圖。", "item": 0 },
   { "say": "圖裡標出左右輪的速度,和兩輪之間的間距 L,它們決定車子的線速度 v 和角速度 omega。圖的右側還列出公式和數值例,可以拿來對照剛剛的計算。", "item": 1 }
  ],
  "cmd_vel 與差速運動學:速度怎麼變成輪子轉動#5": [
   { "say": "來做一個範例計算。", "item": 0 },
   { "say": "設 L 是零點一六公尺,輪半徑零點零三三公尺,這是教育型小車的典型量級,實際請查你的機器人規格。我們想要 v 是每秒零點一五公尺,omega 是每秒零點八弧度。", "item": 1 },
   { "say": "輪子的角速度,等於線速度除以半徑。右輪零點二一四除以零點零三三,大約每秒六點四八弧度,約每分鐘六十二轉。", "item": 2 },
   { "say": "右輪速度是零點一五加零點八乘零點零八,等於零點二一四公尺每秒。", "item": 3 },
   { "say": "左輪速度是零點一五減零點八乘零點零八,等於零點零八六公尺每秒。", "item": 4 },
   { "say": "另外,omega 是零,兩輪同速直走;v 是零但 omega 不是零,兩輪反向轉,原地旋轉。原地轉九十度,角速度零點五,大約需要三點一四秒。", "item": 4 }
  ],
  "cmd_vel 與差速運動學:速度怎麼變成輪子轉動#6": [
   { "say": "再來是里程計,積分出來的位置。", "item": 0 },
   { "say": "驅動 node 讀取輪子編碼器,把速度積分成位置,發布到 odom 這個 topic,同時發布 T F 座標變換。", "item": 1 },
   { "say": "里程計一定會漂移。輪子打滑、地毯、輪徑誤差,都會累積。所以長距離導航要靠雷達定位來修正,不能只信 odom。", "item": 2 },
   { "say": "更新的方式,x 加上 v 乘 cos theta 乘時間。", "item": 3 },
   { "say": "y 加上 v 乘 sin theta 乘時間。", "item": 4 },
   { "say": "theta 加上 omega 乘時間。", "item": 5 }
  ],
  "cmd_vel 與差速運動學:速度怎麼變成輪子轉動#7": [
   { "say": "有一個很重要的觀念,速度指令是持續的狀態,不是一次性的動作。", "item": 0 },
   { "say": "底盤驅動收到 cmd vel 後,會一直照著做,直到收到下一個。這點和瀏覽器模擬器的 set motors 完全一樣:你設定馬達輸出,它就持續運轉,走多遠要自己用 sleep 和里程計決定何時停。所以,要停下來,必須主動發零速度。", "item": 1 },
   { "say": "還有,node 當掉時,最後一個指令可能還在生效,所以要有看門狗,下一個單元就會講。", "item": 2 }
  ],
  "遙控、限速與看門狗:安全的速度指令鏈#1": [
   { "say": "接著是遙控、限速與看門狗,也就是一條安全的速度指令鏈。先看現成的遙控工具。", "item": 0 },
   { "say": "開發初期最實用的是鍵盤遙控,用 teleop twist keyboard 這個套件。", "item": 1 },
   { "say": "TurtleBot 三另外有專用版本,要先設定機型的環境變數,值依機型有 burger、waffle、waffle pi 等。", "item": 2 },
   { "say": "按鍵說明會顯示在終端機。重點是,一開始把速度調小,而且按下停止鍵,通常是空白鍵或 s,要先熟練。套件名稱與參數依發行版而異,請以你安裝的版本為準。", "item": 3 },
   { "say": "也可以不靠遙控程式,直接用 topic pub 以每秒十次的頻率持續發送。要特別小心,按 Ctrl C 結束後,最後一個指令可能仍在生效,請另外發一次零速度。", "item": 4 }
  ],
  "遙控、限速與看門狗:安全的速度指令鏈#2": [
   { "say": "這是前兩種遙控指令。", "item": 0 },
   { "say": "第一行用 ROS 二 run 啟動 teleop twist keyboard。", "item": 1 },
   { "say": "第二行先設定 TurtleBot 三的機型環境變數。", "item": 2 },
   { "say": "第三行啟動 TurtleBot 三專用的鍵盤遙控。", "item": 3 }
  ],
  "遙控、限速與看門狗:安全的速度指令鏈#3": [
   { "say": "再來是用 topic pub 直接發布。", "item": 0 },
   { "say": "第一行是以每秒十次,持續發布小速度,前進零點零五公尺每秒。", "item": 1 },
   { "say": "第二行是只發一次的空訊息,所有欄位為零,用來在結束後讓機器人停下來。", "item": 2 }
  ],
  "遙控、限速與看門狗:安全的速度指令鏈#4": [
   { "say": "為什麼需要速度指令鏈?", "item": 0 },
   { "say": "實際系統裡,會有好幾個想控制機器人的來源,像鍵盤遙控、Nav 二,還有你寫的 A I node。如果都直接發 cmd vel,指令會互相覆蓋,出了事也沒辦法統一限制。", "item": 1 },
   { "say": "常見做法是,各來源發到自己的 topic,由仲裁 node,例如 twist mux 套件,依優先權選一個,再經過限速與看門狗,最後才到底盤。", "item": 1 }
  ],
  "遙控、限速與看門狗:安全的速度指令鏈#5": [
   { "say": "這張是速度指令鏈圖。", "item": 0 },
   { "say": "由左往右看,遙控、Nav 二、A I 指令三個來源,先經過 twist mux 仲裁,再經過限速與看門狗,最後送到馬達。注意看,急停是獨立的,直接切斷馬達,不經過前面這條軟體鏈。", "item": 1 }
  ],
  "遙控、限速與看門狗:安全的速度指令鏈#6": [
   { "say": "我們來看限速與看門狗 node 的範例。", "item": 0 },
   { "say": "這個 node 訂閱 cmd vel raw,把速度限制在參數指定的範圍,並以固定頻率發布 cmd vel。超過逾時秒數沒收到新指令,就送零。", "item": 1 },
   { "say": "初始化的地方,宣告三個參數。最大線速度預設零點一公尺每秒,先設保守;最大角速度零點八弧度每秒;逾時零點五秒。接著建立訂閱、發布,還有一個每秒二十次的計時器。", "item": 2 },
   { "say": "clamp 函式負責限幅。如果數值不是有限的,就是 NaN 或無限大,直接回傳零,否則把數值夾在正負上限之間。", "item": 3 },
   { "say": "收到指令的回呼,把線速度和角速度都限幅,存起來,並記錄收到的時間。", "item": 4 },
   { "say": "計時器回呼,算出距離上次收到指令過了多久,超過逾時就把輸出全部歸零,然後固定頻率發布。重點是,要檢查 NaN 與無限大,固定頻率輸出,逾時歸零。如果底盤型別是 TwistStamped,要改訊息型別。啟動時可以用參數調整,例如把最大線速度改成零點零五。", "item": 5 }
  ],
  "遙控、限速與看門狗:安全的速度指令鏈#7": [
   { "say": "畫面上是這支 node 的開頭部分。", "item": 0 },
   { "say": "匯入 math,用來檢查數值是不是有限。", "item": 1 },
   { "say": "匯入 R C L py。", "item": 2 },
   { "say": "匯入 Node 類別。", "item": 3 },
   { "say": "匯入 Twist 訊息型別。", "item": 4 },
   { "say": "最後定義 VelocityLimiter 這個類別。", "item": 5 }
  ],
  "rosbag2:錄製、重播與檢視#1": [
   { "say": "最後一個單元,rosbag 二,錄製、重播與檢視。為什麼要錄製資料?", "item": 0 },
   { "say": "機器人實測很花時間,要電池、場地、人力。rosbag 二能把 topic 的訊息連同時間戳記錄成檔案,事後可以重播。", "item": 0 },
   { "say": "第一個用途是除錯,發生問題時回頭看當時的 scan、odom、cmd vel。", "item": 1 },
   { "say": "第二個是離線開發,沒有機器人也能用錄好的資料測試 SLAM 或偵測演算法。", "item": 2 },
   { "say": "第三個是回歸測試,改了演算法後,用同一份資料比較結果。", "item": 3 }
  ],
  "rosbag2:錄製、重播與檢視#2": [
   { "say": "這張是 rosbag 二的工作流程圖。", "item": 0 },
   { "say": "流程有四步:錄製、檢視、重播、分析。圖上還特別提醒,重播會真的把訊息發布出去,這一點等一下會再強調。", "item": 1 }
  ],
  "rosbag2:錄製、重播與檢視#3": [
   { "say": "來看基本指令。", "item": 0 },
   { "say": "用 bag record 錄製,加上 減 o 指定輸出資料夾名稱,後面接要錄的 topic。資料夾如果已存在會報錯,這是為了避免覆蓋。加上 減 a 會錄所有 topic,檔案可能非常大。", "item": 1 },
   { "say": "bag info 可以看時間長度、訊息數、各 topic 型別。bag play 重播,還能調慢速度、循環播放,或同時發布 clock 配合模擬時間。儲存格式依版本而異,Humble 預設是 sqlite 三,較新的版本可能預設使用 mcap,可以用 bag info 查看。", "item": 1 }
  ],
  "rosbag2:錄製、重播與檢視#4": [
   { "say": "前半段指令。", "item": 0 },
   { "say": "第一行,錄製 cmd vel、odom、scan 和 T F 這四個 topic。", "item": 1 },
   { "say": "第二行,錄所有 topic,檔案可能非常大。", "item": 2 },
   { "say": "第三行,bag info 看時間長度、訊息數,和各 topic 的型別。", "item": 3 }
  ],
  "rosbag2:錄製、重播與檢視#5": [
   { "say": "後半段是重播的指令。", "item": 0 },
   { "say": "第一行是直接重播。", "item": 1 },
   { "say": "第二行加上 rate 零點五,是慢速重播。", "item": 2 },
   { "say": "第三行加上 loop,是循環播放。", "item": 3 },
   { "say": "第四行加上 clock,同時發布 clock,要搭配 use sim time 使用。", "item": 4 }
  ],
  "rosbag2:錄製、重播與檢視#6": [
   { "say": "接下來是重播的安全問題,這很重要。", "item": 0 },
   { "say": "重播會把錄下的訊息真的發布出去。如果 bag 裡有 cmd vel,而你同時連著真機,機器人會照著當時的指令動。重播到真機前,請注意以下幾點。", "item": 0 },
   { "say": "第一,只重播感測器 topic,例如 scan、odom、T F。這個選項依版本而異,請用 bag play 加 h 確認。", "item": 1 },
   { "say": "第二,或是讓機器人輪子架高,先斷開馬達電源。", "item": 2 },
   { "say": "第三,T F 和 odom 會跟真正運作中的驅動 node 的資料衝突。離線分析時,要確定機器人驅動沒有在跑。", "item": 3 }
  ],
  "rosbag2:錄製、重播與檢視#7": [
   { "say": "最後,估算一下檔案大小。", "item": 0 },
   { "say": "相機和點雲的資料量很大。例如一張六百四十乘四百八十的影像,每個像素三個位元組,一張就是九十二萬多位元組,每秒三十張,大約是每秒約二十七點六 M B,錄一分鐘約一點六 G B。雷達和 odom 則小得多,每秒數十到數百 K B。對策有三個。", "item": 0 },
   { "say": "第一,只錄需要的 topic,不要用 減 a。", "item": 1 },
   { "say": "第二,影像用壓縮型別,如果驅動有提供。", "item": 2 },
   { "say": "第三,錄製前先確認硬碟空間,用 df 減 h 這個指令。", "item": 3 }
  ],
  "closing": [
   { "say": "好,這一章我們學了 cmd vel 與差速運動學、里程計會漂移、遙控搭配限速與看門狗的安全鏈,還有 rosbag 錄製與重播要注意的安全問題。", "item": 0 },
   { "say": "請接著完成本章的實作,並做章末小測驗。下一章見。", "item": 1, "pause": 1 }
  ]
 }
}
