{
 "byKey": {
  "cover": [
   { "say": "大家好,歡迎回到從無到有打造 A I 機器人,機械手臂版。這一章,我們要學正運動學,也就是給你每個關節的角度,怎麼算出夾爪末端到底在哪裡。", "item": 0 }
  ],
  "原理:正向運動學就是旋轉與向量相加#1": [
   { "say": "我們先用走路指路來打個比方。", "item": 0 },
   { "say": "有人問你,從車站怎麼走到學校,你說,往東北走十二公尺,再轉向正東走十公尺。每一段,都是方向加上長度,把所有段接起來,終點就在你的出發點,加上這些位移的總和。手臂的每一節連桿,就是這樣的一段位移。", "item": 1 }
  ],
  "原理:正向運動學就是旋轉與向量相加#2": [
   { "say": "再來看背後的數學原理,其實就是旋轉與向量。", "item": 0 },
   { "say": "一個長度為 L、方向角為 phi 的連桿,對應的位移向量,水平分量是 L 乘上 cos phi,垂直分量是 L 乘上 sin phi。", "item": 1 },
   { "say": "cos 和 sin 的來源是單位圓,把一個長度為一、朝正 x 方向的向量,轉 theta 角以後,座標就變成 cos theta 和 sin theta。", "item": 1 },
   { "say": "關節的關鍵在於角度累加。第二節連桿接在第一節的末端,所以它被第一個關節帶著轉了 theta 一,再自己轉 theta 二,因此它對水平的方向,是 theta 一加 theta 二。", "item": 2 },
   { "say": "於是末端的位置,就是第一節向量,加上第二節向量。也就是兩個向量,首尾相接再相加。", "item": 3 }
  ],
  "原理:正向運動學就是旋轉與向量相加#3": [
   { "say": "把剛剛的想法寫成式子。", "item": 0 },
   { "say": "末端等於 L 一乘上 cos theta 一、sin theta 一,加上 L 二乘上 cos 和 sin 的 theta 一加 theta 二。這就是兩個向量相加的寫法。", "item": 1 }
  ],
  "原理:正向運動學就是旋轉與向量相加#4": [
   { "say": "這張是旋轉的示意圖。", "item": 0 },
   { "say": "圖裡的單位向量,從正 x 方向轉了六十度,水平分量是 cos 六十度,等於零點五,垂直分量是 sin 六十度,大約零點八六六。", "item": 1 }
  ],
  "原理:正向運動學就是旋轉與向量相加#5": [
   { "say": "這張圖是向量相加。", "item": 0 },
   { "say": "第一節的向量 v 一,和第二節的向量 v 二,首尾相接。從原點到 v 二終點的那條紅色虛線,就是末端的位置。", "item": 1 }
  ],
  "原理:正向運動學就是旋轉與向量相加#6": [
   { "say": "我們用 Python 做個數值例題驗算。", "item": 0 },
   { "say": "設定 L 一等於十二,L 二等於十,theta 一是六十度,theta 二是負三十度。", "item": 1 },
   { "say": "算出來,第一節向量大約是六點零零、十點三九,第二節向量大約是八點六六、五點零零,相加得到十四點六六、十五點三九。這和第一個單元用公式算出來的結果完全相同,公式只是把這個向量相加,寫成式子而已。", "item": 2 }
  ],
  "原理:正向運動學就是旋轉與向量相加#7": [
   { "say": "畫面上是剛剛驗算的程式。", "item": 0 },
   { "say": "先匯入數學套件。", "item": 1 },
   { "say": "再把角度換成弧度的函式,取一個短名字。", "item": 2 },
   { "say": "第一節向量,是十二乘上六十度的 cos 和 sin。", "item": 3 },
   { "say": "第二節向量,是十乘上三十度的 cos 和 sin,因為方向是 theta 一加 theta 二,也就是三十度。最後把兩個向量相加印出來。", "item": 4 }
  ],
  "平面連桿的正向運動學推導#1": [
   { "say": "好,我們正式來推導平面連桿的正運動學。", "item": 0 },
   { "say": "正運動學,英文是 Forward Kinematics,回答一個問題,已知各關節的角度和連桿長度,夾爪末端在哪裡?它是整個手臂控制的基礎。知道末端在哪,才談得上檢查是否會撞到桌面、是否在工作區內,也才能驗證第五章的逆運動學算得對不對。", "item": 1 },
   { "say": "我們從最簡單的平面二連桿開始。肩關節在原點,第一節連桿長 L 一,和水平線夾角 theta 一,逆時針為正。第二節連桿長 L 二,相對於第一節,再轉了 theta 二,逆時針也是正。", "item": 2 }
  ],
  "平面連桿的正向運動學推導#2": [
   { "say": "這張圖是平面二連桿的正運動學。", "item": 0 },
   { "say": "圖裡第一節跟水平夾六十度,第二節相對於第一節,再轉負三十度,末端的位置,由兩節連桿的向量相加而得。圖中列出了公式,還有代入的結果。", "item": 1 }
  ],
  "平面連桿的正向運動學推導#3": [
   { "say": "我們一步一步,把兩個向量加起來。", "item": 0 },
   { "say": "第一節連桿的末端,也就是肘的座標,是 L 一乘 cos theta 一,和 L 一乘 sin theta 一。", "item": 1 },
   { "say": "第二節連桿相對於水平的方向,是 theta 一加 theta 二。角度會累加,因為第二節是接在第一節上,被一起帶著轉。所以它貢獻的位移,是 L 二乘 cos 和 sin 的 theta 一加 theta 二。", "item": 2 },
   { "say": "把兩段相加,就是末端位置。", "item": 3 },
   { "say": "用口語說,x 等於第一節連桿的水平分量,加上第二節連桿的水平分量,y 也是同樣的道理。", "item": 4 }
  ],
  "平面連桿的正向運動學推導#4": [
   { "say": "這一頁是推導出來的公式。", "item": 0 },
   { "say": "肘的座標,是 L 一乘 cos theta 一,和 L 一乘 sin theta 一。", "item": 1 },
   { "say": "第二節貢獻的位移,是 L 二乘 cos 和 sin 的 theta 一加 theta 二。", "item": 2 },
   { "say": "x 等於 L 一乘 cos theta 一,加上 L 二乘 cos 的 theta 一加 theta 二。", "item": 3 },
   { "say": "y 等於 L 一乘 sin theta 一,加上 L 二乘 sin 的 theta 一加 theta 二。", "item": 4 }
  ],
  "平面連桿的正向運動學推導#5": [
   { "say": "來看第一個數值例題。", "item": 0 },
   { "say": "L 一是十二公分,L 二是十公分,theta 一是六十度,theta 二是負三十度,意思是第二節往順時針折下來三十度。所以總方向是六十減三十,三十度。", "item": 1 },
   { "say": "x 是十二乘 cos 六十度,加十乘 cos 三十度,也就是六加八點六六,等於十四點六六公分。y 是十二乘 sin 六十度,加十乘 sin 三十度,也就是十點三九二加五,等於十五點三九公分。所以末端在十四點六六、十五點三九。", "item": 2 },
   { "say": "再用 Python 驗算。畫面上的程式,是把角度換成弧度,第一節用 theta 一,第二節用 theta 一加 theta 二,然後把兩節的水平分量相加,垂直分量也相加,回傳末端座標。", "item": 3 }
  ],
  "平面連桿的正向運動學推導#6": [
   { "say": "這一頁是剛剛的手算過程。", "item": 0 },
   { "say": "第一行,theta 一加 theta 二,等於三十度。", "item": 1 },
   { "say": "第二行,算 x,十二乘零點五,加十乘零點八六六,等於十四點六六。", "item": 2 },
   { "say": "第三行,算 y,十二乘零點八六六,加十乘零點五,等於十五點三九。", "item": 3 }
  ],
  "平面連桿的正向運動學推導#7": [
   { "say": "這一頁是驗算用的 Python 程式。", "item": 0 },
   { "say": "先匯入數學套件。", "item": 1 },
   { "say": "定義一個二連桿正運動學的函式,輸入兩節連桿長度,和兩個關節角度。", "item": 2 },
   { "say": "最後呼叫它,代入十二、十、六十、負三十,印出來的結果,大約是十四點六六、十五點三九二。", "item": 3 }
  ],
  "座標系、底座旋轉與 DH 概念簡化#1": [
   { "say": "接下來,我們看多軸手臂,三維位置是怎麼來的。", "item": 0 },
   { "say": "前面算的是平面內的位置。真實的手臂多了底座旋轉關節,整個手臂的垂直平面,可以繞著底座的垂直軸,轉一個角度 phi。所以三維位置分兩步。", "item": 0 },
   { "say": "第一步,先在手臂自己的垂直平面內做正運動學,得到水平距離 r 和高度 h。肩關節離桌面的高度,也要加進 h。", "item": 1 },
   { "say": "第二步,再用底座角度 phi,把 r 轉到桌面座標。", "item": 2 }
  ],
  "座標系、底座旋轉與 DH 概念簡化#2": [
   { "say": "桌面座標的算法如下。", "item": 0 },
   { "say": "x 等於 r 乘 cos phi。", "item": 1 },
   { "say": "y 等於 r 乘 sin phi。", "item": 2 },
   { "say": "z 等於 h。", "item": 3 },
   { "say": "舉例,r 是十五公分,phi 是四十度,h 是八公分。x 就是十五乘 cos 四十度,等於十五乘零點七六六,約十一點四九公分。", "item": 4 }
  ],
  "座標系、底座旋轉與 DH 概念簡化#3": [
   { "say": "接著算另外兩個座標。", "item": 0 },
   { "say": "y 是十五乘 sin 四十度,等於十五乘零點六四二八,約九點六四公分。", "item": 1 },
   { "say": "z 就是 h,八公分。這裡有個提醒,同一個符號 y,在側視圖代表高度,在桌面座標代表左右,所以課本和程式裡,要明確標示你用的是哪個座標系。下面的模擬器為了簡化,側視平面用 x 和 y,分別代表水平距離和高度。", "item": 2 }
  ],
  "座標系、底座旋轉與 DH 概念簡化#4": [
   { "say": "這張圖是完整手臂的座標分解。", "item": 0 },
   { "say": "圖裡分成兩個視角。俯視圖,用底座角度 phi 和水平距離 r,決定桌面上的 x 和 y。側視圖,用 r 和高度 h,決定末端在垂直平面上的位置。", "item": 1 }
  ],
  "座標系、底座旋轉與 DH 概念簡化#5": [
   { "say": "我們來整理一下,座標系是什麼。", "item": 0 },
   { "say": "座標系就是量位置的尺,有原點,也有方向。手臂至少有三個。第一個是底座座標系,原點在底座中心的桌面上,x 向前、y 向左、z 向上。所有位置,最後都要換算到這個座標。", "item": 1 },
   { "say": "第二個是關節座標系,每個關節各有一個,跟著連桿一起轉動。", "item": 2 },
   { "say": "第三個是相機座標系,是相機畫面上的像素位置,第八章要學怎麼換成桌面座標。運動學的工作,就是在這些座標系之間轉換。", "item": 3 }
  ],
  "座標系、底座旋轉與 DH 概念簡化#6": [
   { "say": "最後介紹,用矩陣來表示,這叫齊次轉換。", "item": 0 },
   { "say": "在平面中,繞原點轉 theta,再平移,可以寫成一個三乘三的矩陣,連桿一節一節接起來,就是矩陣連乘。", "item": 1 },
   { "say": "第 i 節的轉換矩陣,左上角是旋轉,也就是 cos 和 sin,最右邊那一欄,是連桿長度乘上 cos 和 sin,最下面一列固定是零、零、一。整條手臂,就是把每一節的矩陣依序乘起來,最右欄就是末端的位置。", "item": 2 },
   { "say": "用 numpy 驗算,畫面上的函式,就是把這個矩陣組出來。", "item": 3 },
   { "say": "把六十度、十二,和負三十度、十,兩個矩陣相乘,取出最右欄,結果和前面的十四點六六、十五點三九一致。矩陣的好處是,多一個關節就多乘一個矩陣,三維手臂也是同樣的想法,只是改成四乘四。", "item": 4 }
  ],
  "座標系、底座旋轉與 DH 概念簡化#7": [
   { "say": "這一頁是剛剛矩陣驗算的程式。", "item": 0 },
   { "say": "第一行是旋轉加平移的矩陣,第一列是 cos、負 sin、連桿長度乘 cos。", "item": 1 },
   { "say": "接著匯入 numpy 和數學套件。", "item": 2 },
   { "say": "再定義函式,輸入角度和連桿長度,回傳那個三乘三矩陣。", "item": 3 },
   { "say": "最後把兩個矩陣相乘,取最右欄,就是末端的位置。", "item": 4 }
  ],
  "對應模擬器:arm 的座標與角度約定#1": [
   { "say": "好,最後一個單元,對應到模擬器。", "item": 0 },
   { "say": "我們瀏覽器裡的手臂模擬器,是側視二維平面的三自由度手臂,加上夾爪。有三個關節編號。", "item": 1 },
   { "say": "零號是底座旋轉,範圍負九十度到九十度。一號是肩,範圍零到一百八十度。二號是肘,範圍零到一百五十度。單位是公分和度。前面的校準、這一章的正運動學、下一章的逆運動學,在模擬器裡都已經校準完成,你不需要處理脈寬,專心處理運動學和流程邏輯就可以了。", "item": 2 }
  ],
  "對應模擬器:arm 的座標與角度約定#2": [
   { "say": "這是三個關節的設定指令。", "item": 0 },
   { "say": "設定零號關節,是底座旋轉,範圍負九十度到九十度。", "item": 1 },
   { "say": "設定一號關節,是肩,範圍零度到一百八十度。", "item": 2 },
   { "say": "設定二號關節,是肘,範圍零度到一百五十度。", "item": 3 }
  ],
  "對應模擬器:arm 的座標與角度約定#3": [
   { "say": "模擬器和實體手臂,有哪些對應與簡化呢?", "item": 0 },
   { "say": "實體手臂,底座旋轉在俯視平面,其餘關節在垂直平面,需要前面說的 phi、r、h 三步。", "item": 1 },
   { "say": "模擬器則是側視平面內的二連桿,加上底座旋轉角 yaw。物體用 r 和 yaw 描述,r 是離底座中心的水平距離,yaw 是方位角。所以手臂位置函式回傳的是 r 和 h,也就是水平距離和高度,底座旋轉由設定零號關節另外控制。", "item": 2 },
   { "say": "另外,實體手臂的第三個運動關節是腕,模擬器把夾爪簡化成末端點,第三個自由度留給底座旋轉。", "item": 3 }
  ],
  "對應模擬器:arm 的座標與角度約定#4": [
   { "say": "再提醒一次。", "item": 0 },
   { "say": "實體有重力、背隙、電源壓降和相機誤差,模擬器沒有,所以它是邏輯練習場,不是實機測試的替代品。", "item": 1 }
  ],
  "對應模擬器:arm 的座標與角度約定#5": [
   { "say": "接下來看模擬器的幾何和角度約定。", "item": 0 },
   { "say": "兩節連桿長度都是二十公分,肩關節離桌面十二公分。肩角 a 一,從水平線往上量。肘角 a 二,表示前臂相對於上臂,往下彎了多少度,a 二等於零的時候完全伸直。所以前臂對水平的角度,是 a 一減 a 二。", "item": 1 },
   { "say": "對應到剛剛課本的寫法,theta 一等於 a 一,theta 二等於負 a 二,另外高度要加上肩高。", "item": 2 },
   { "say": "舉例,a 一是六十度,a 二是三十度。肘的位置是十點零零、二十九點三二,前臂角度是三十度,末端是二十七點三二、三十九點三二。用 Python 驗算也是同樣的結果。", "item": 3 },
   { "say": "另外有幾個驗算用的姿勢。a 一九十度、a 二零度,末端在零、五十二,手臂直直向上。", "item": 4 },
   { "say": "a 一九十度、a 二九十度,末端在二十、三十二,上臂向上、前臂水平朝前,這是模擬器的初始姿勢。a 一零度、a 二零度,末端在四十、十二,手臂水平伸到最遠。a 一和 a 二都是四十五度,末端在三十四點一四、二十六點一四。", "item": 4 }
  ],
  "對應模擬器:arm 的座標與角度約定#6": [
   { "say": "這是模擬器手臂的正運動學公式。", "item": 0 },
   { "say": "肘的位置,x 是二十乘 cos a 一,y 是十二加二十乘 sin a 一。", "item": 1 },
   { "say": "末端的 x,是二十乘 cos a 一,加二十乘 cos 的 a 一減 a 二。", "item": 2 },
   { "say": "末端的 y,是十二,加二十乘 sin a 一,再加二十乘 sin 的 a 一減 a 二。", "item": 3 }
  ],
  "對應模擬器:arm 的座標與角度約定#7": [
   { "say": "把 a 一等於六十度、a 二等於三十度代進去。", "item": 0 },
   { "say": "肘的位置,是二十乘 cos 六十度,等於十,y 是十二加二十乘 sin 六十度,等於二十九點三二。", "item": 1 },
   { "say": "前臂的角度,是六十減三十,三十度。", "item": 2 },
   { "say": "末端 x 是十加二十乘 cos 三十度,等於二十七點三二,y 是二十九點三二加十,等於三十九點三二。", "item": 3 }
  ],
  "closing": [
   { "say": "好,這一章我們學了正運動學,從旋轉與向量相加,推導出平面二連桿的公式,再加上底座旋轉得到三維位置,最後對應到模擬器的角度約定。", "item": 0 },
   { "say": "接下來請完成本章的實作,再做章末小測驗,檢查自己學會了多少。下一章見。", "item": 1, "pause": 1 }
  ]
 }
}
