{
 "byKey": {
  "cover": [
   { "say": "大家好,歡迎回到從無到有打造 A I 機器人,機械手臂版。這一章,我們要學逆運動學,英文縮寫 I K,就是給你一個目標位置,反過來算出各個關節要轉到幾度。", "item": 0 }
  ],
  "原理:逆向運動學——餘弦定理與兩圓交點#1": [
   { "say": "我們先用兩根竿子,來打個比方。", "item": 0 },
   { "say": "你拿兩根接在一起的竿子,想讓竿尖碰到牆上的一點。竿子的長度是固定的,所以肘能出現的位置有限,它必須離肩剛好是 L 一,同時離目標剛好是 L 二。滿足這兩個距離的點,就是兩個圓的交點。", "item": 1 }
  ],
  "原理:逆向運動學——餘弦定理與兩圓交點#2": [
   { "say": "這就是幾何原理,兩個圓的交點。", "item": 0 },
   { "say": "以肩為圓心、半徑 L 一畫一個圓,代表肘可能在的地方。再以目標為圓心、半徑 L 二,畫另一個圓。兩個圓要有交點才有解。", "item": 1 },
   { "say": "分成三種情況。有兩個交點,就是肘上和肘下兩種解。只有一個交點,是兩圓相切,代表手臂伸直或折疊。沒有交點,就是目標太遠或太近,不可達。", "item": 1 }
  ],
  "原理:逆向運動學——餘弦定理與兩圓交點#3": [
   { "say": "這張是兩圓相交的示意圖。", "item": 0 },
   { "say": "圖裡兩個交點,對應肘上和肘下兩組解。兩個圓相切的時候,只有一個奇異解。兩個圓不相交,就表示目標不可達。", "item": 1 }
  ],
  "原理:逆向運動學——餘弦定理與兩圓交點#4": [
   { "say": "接著是代數原理,餘弦定理。", "item": 0 },
   { "say": "肩、肘、目標,三點構成一個三角形,三邊分別是 L 一、L 二,和目標的距離 d。", "item": 1 },
   { "say": "套用餘弦定理,d 的平方,等於 L 一平方加 L 二平方,減去兩倍的 L 一乘 L 二乘上 cos beta,beta 就是肘的內角。", "item": 2 },
   { "say": "整理一下,cos beta 等於 L 一平方加 L 二平方減 d 平方,再除以兩倍的 L 一乘 L 二。關節角 theta 二,等於正負一百八十度減 beta,正負號就是兩組解。肩的角度,則是目標方向角,加減三角形在肩的內角 alpha。", "item": 3 }
  ],
  "原理:逆向運動學——餘弦定理與兩圓交點#5": [
   { "say": "這張圖是餘弦定理的示意。", "item": 0 },
   { "say": "由三邊長 L 一、L 二和 d,可以求出三角形的內角 alpha 和 beta,再換算成肩和肘的關節角。", "item": 1 }
  ],
  "原理:逆向運動學——餘弦定理與兩圓交點#6": [
   { "say": "我們用 Python 做個數值例題驗算。", "item": 0 },
   { "say": "L 一是十二,L 二是十,目標在十五、八。先算距離 d,是十七。再用餘弦定理算出 beta,大約一百點八一度,alpha 大約三十五點三度,目標的方向角大約二十八點零七度。", "item": 1 },
   { "say": "結果,theta 二是正負七十九點一九度。theta 一是二十八點零七度,正負三十五點三度,也就是六十三點三七度,或是負七點二二度。", "item": 2 },
   { "say": "兩個肘的位置分別是五點三八、十點七三,和十一點九、負一點五一。後者的肘在 x 軸下方,也就是桌面以下,所以桌上的手臂要選肘上。同一個結果,也可以用兩圓交點公式算出來,兩者一致。", "item": 2 }
  ],
  "原理:逆向運動學——餘弦定理與兩圓交點#7": [
   { "say": "畫面上就是剛剛的驗算程式,我們看重點。", "item": 0 },
   { "say": "先匯入數學套件。", "item": 1 },
   { "say": "設定兩節連桿長度,和目標的座標。", "item": 2 },
   { "say": "用 hypot 算出目標距離,是十七。", "item": 3 },
   { "say": "再用反餘弦,依餘弦定理算出 beta 和 alpha,最後印出三個數字,七十九點一九、六十三點三七、負七點二二。", "item": 4 }
  ],
  "平面二連桿逆運動學:餘弦定律解析解#1": [
   { "say": "好,我們來推導平面二連桿的逆運動學,用餘弦定律求解析解。", "item": 0 },
   { "say": "逆運動學,是正運動學的反問題。我想讓夾爪到某個位置,各個關節要轉到幾度?抓取任務一定會用到它,因為相機告訴你方塊在哪裡,你要把它換成關節角度,才能命令伺服馬達。", "item": 1 },
   { "say": "正運動學一定有唯一的答案,逆運動學卻可能有零個、一個或兩個解,這是它比較難的地方。對平面二連桿,我們可以用幾何直接推出解析解,也就是公式,不需要疊代。", "item": 2 }
  ],
  "平面二連桿逆運動學:餘弦定律解析解#2": [
   { "say": "這張是逆運動學的幾何圖。", "item": 0 },
   { "say": "肩、肘和目標點,形成一個三角形,三邊是 L 一、L 二,和目標的距離 d。圖中用餘弦定律求出肘角,再求肩角,也列出目標在十五、八的計算步驟。", "item": 1 }
  ],
  "平面二連桿逆運動學:餘弦定律解析解#3": [
   { "say": "我們一步一步推導。", "item": 0 },
   { "say": "目標在 x、y,肩在原點。令 d 平方,等於 x 平方加 y 平方。第一步,用餘弦定律求肘角,把正運動學的公式,兩邊平方相加,得到 x 平方加 y 平方,等於 L 一平方加 L 二平方,加上兩倍的 L 一乘 L 二乘 cos theta 二。", "item": 1 },
   { "say": "所以 cos theta 二,等於 x 平方加 y 平方,減 L 一平方,減 L 二平方,再除以兩倍的 L 一乘 L 二。", "item": 2 },
   { "say": "如果這個值的絕對值大於一,代表目標不在可及範圍,下一個單元會談。", "item": 3 },
   { "say": "第二步求 theta 二。正負兩個符號,就是肘上和肘下兩個解。更穩健的寫法,是先算出 s 等於正負根號下一減 c 平方,再用 atan2 算出 theta 二。用 atan2 可以避免反餘弦在邊界的浮點誤差,而且模擬器的程式環境,也只提供 atan2,不提供反餘弦。", "item": 4 },
   { "say": "第三步求 theta 一。目標方向角,減去第二節造成的偏角。用口語說,就是先朝目標方向看,再扣掉因為肘彎曲而偏掉的角度。", "item": 5 }
  ],
  "平面二連桿逆運動學:餘弦定律解析解#4": [
   { "say": "這一頁是推導用到的公式。", "item": 0 },
   { "say": "第一個是,x 平方加 y 平方,等於 L 一平方加 L 二平方,加兩倍的 L 一乘 L 二乘 cos theta 二。", "item": 1 },
   { "say": "第二個是,cos theta 二,等於 x 平方加 y 平方,減 L 一平方減 L 二平方,除以兩倍的 L 一乘 L 二。", "item": 2 }
  ],
  "平面二連桿逆運動學:餘弦定律解析解#5": [
   { "say": "再看另外兩個公式。", "item": 0 },
   { "say": "s 等於正負根號下一減 c 平方,theta 二等於 atan2 的 s 和 c。", "item": 1 },
   { "say": "theta 一,等於 atan2 的 y 和 x,減掉 atan2 的 L 二乘 sin theta 二,和 L 一加 L 二乘 cos theta 二。", "item": 2 }
  ],
  "平面二連桿逆運動學:餘弦定律解析解#6": [
   { "say": "接下來是完整的數值例題。", "item": 0 },
   { "say": "L 一是十二,L 二是十,目標在十五、八。先算 x 平方加 y 平方,等於二百二十五加六十四,二百八十九,所以 d 是十七。cos theta 二等於四十五除以二百四十,等於零點一八七五,theta 二就是正負七十九點一九度。", "item": 1 },
   { "say": "先取肘上,theta 二是負七十九點一九度。目標方向角是二十八點零七度,第二節造成的偏角是負三十五點三度,相減得到 theta 一,是六十三點三七度。", "item": 2 },
   { "say": "再取肘下,theta 二是正七十九點一九度,theta 一是二十八點零七減三十五點三,等於負七點二二度。", "item": 3 },
   { "say": "用 Python 驗算,畫面上的函式,先算 c,如果它的絕對值大於一,就回傳 None,表示不可達。接著算 s,肘上就取負號,再用 atan2 算出 theta 二和 theta 一,最後轉成度數。呼叫之後,結果是六十三點三七,和負七十九點一九。", "item": 4 },
   { "say": "最重要的是這一句,算完用正運動學代回去驗證,是逆運動學最重要的測試習慣。", "item": 5 }
  ],
  "平面二連桿逆運動學:餘弦定律解析解#7": [
   { "say": "這一頁是手算的前半部。", "item": 0 },
   { "say": "x 平方加 y 平方,等於二百八十九,d 是十七。", "item": 1 },
   { "say": "cos theta 二,等於四十五除以二百四十,是零點一八七五。", "item": 2 },
   { "say": "theta 二,等於正負七十九點一九度。", "item": 3 },
   { "say": "目標方向角,atan2 的八和十五,是二十八點零七度。", "item": 4 }
  ],
  "肘上與肘下、可達範圍與奇異點#1": [
   { "say": "好,接下來談肘上、肘下,可達範圍,還有奇異點。先看為什麼會有兩個解。", "item": 0 },
   { "say": "同一個目標點,二連桿可以用兩種姿勢到達,肘在連線上方,叫肘上,或者在下方,叫肘下。就像你用手臂碰桌上一個東西,肘可以往上抬,也可以往下垂。數學上,就是 theta 二的正負號。", "item": 0 },
   { "say": "那怎麼選呢?第一,避開障礙和桌面。桌上型手臂的肩離桌面不高,肘下的肘可能撞進桌面,所以預設選肘上。", "item": 1 },
   { "say": "第二,看關節限位。兩個解當中,有一個可能超出某個關節的限位,就只能選另一個。", "item": 2 },
   { "say": "第三,看連續性。如果手臂已經在某個姿勢,就選和目前姿勢差距較小的解,避免手臂突然翻轉,從肘上變肘下。", "item": 3 },
   { "say": "第四,看夾爪朝向。有腕關節的時候,還要考慮夾爪是不是朝下。實務上的做法是,兩個解都算,先過濾掉不合法的,例如超過限位、碰到桌面,剩下的選離目前角度最近的。", "item": 4 }
  ],
  "肘上與肘下、可達範圍與奇異點#2": [
   { "say": "這張圖畫的是,同一個目標點的兩種手臂姿勢。", "item": 0 },
   { "say": "實線是肘上,虛線是肘下。你可以看到,肘下的姿勢,肘部掉到了桌面高度以下,這就是為什麼桌上手臂要選肘上。", "item": 1 }
  ],
  "肘上與肘下、可達範圍與奇異點#3": [
   { "say": "再來是可達範圍。", "item": 0 },
   { "say": "d 是目標離肩的距離,等於 x 平方加 y 平方開根號。能到達的條件是,d 要大於等於 L 一與 L 二差的絕對值,也要小於等於 L 一加 L 二。", "item": 1 },
   { "say": "最遠,是 d 等於 L 一加 L 二,手臂完全伸直。最近,是 d 等於 L 一與 L 二差的絕對值,完全折疊。例如 L 一是十二、L 二是十,可達範圍就是離肩二公分到二十二公分的圓環。", "item": 2 },
   { "say": "實際可達範圍更小。關節限位、桌面,也就是 y 不能低於零,還有手臂與底座的實體碰撞,都會再削減。以模擬器為例,兩節都是二十公分,最遠四十公分。因為肘角上限是一百五十度,最近距離大約是十點三五公分,也就是離肩十點三五公分以內的點,也到不了。", "item": 3 }
  ],
  "肘上與肘下、可達範圍與奇異點#4": [
   { "say": "這是可達範圍的公式。", "item": 0 },
   { "say": "第一個,d 要在 L 一減 L 二的絕對值,和 L 一加 L 二之間。", "item": 1 },
   { "say": "第二個,最近距離,等於根號下 L 一平方加 L 二平方,加兩倍的 L 一乘 L 二乘 cos 一百五十度。代入數字,是根號下八百減六百九十二點八,大約十點三五公分。", "item": 2 }
  ],
  "肘上與肘下、可達範圍與奇異點#5": [
   { "say": "這張是二連桿手臂的可及範圍圖。", "item": 0 },
   { "say": "外圈是 L 一加 L 二的最大伸展,內圈是兩節長度之差。圖上也標出了手臂伸直和折疊,這兩種奇異位置。", "item": 1 }
  ],
  "肘上與肘下、可達範圍與奇異點#6": [
   { "say": "最後是奇異點,也就是邊界附近的麻煩。", "item": 0 },
   { "say": "奇異點,是手臂失去某個方向運動能力的姿勢。對二連桿,就是伸直或折疊。數學上,速度關係的雅可比矩陣行列式,等於 L 一乘 L 二乘 sin theta 二。theta 二趨近零度或一百八十度的時候,它趨近零,表示末端要多走一點點距離,關節要轉很大的角度。", "item": 0 },
   { "say": "數值例子,L 一十二、L 二十。目標離肩二十一點九公分的時候,theta 二大約十點九八度,離肩二十二公分的時候,theta 二是零度。", "item": 0 },
   { "say": "目標只多零點一公分,肘角就要變十點九八度。相反地,在中間位置,十五公分變十五點一公分,theta 二只從九十四點五四度,變成九十三點八二度,只變零點七二度。", "item": 0 },
   { "say": "也就是說,接近完全伸直的時候,微小的位置誤差或雜訊,會造成劇烈的關節運動,甚至在兩個解之間跳動。工程上的做法有三個。", "item": 0 },
   { "say": "第一,工作區設計時留安全邊界,只使用最近距離加邊界,到最遠距離減邊界之間,例如最遠只用到百分之九十五。", "item": 1 },
   { "say": "第二,目標超出邊界的時候,拒絕,或者縮到邊界內,而且要明確記錄。", "item": 2 },
   { "say": "第三,軌跡規劃的時候,避開奇異點附近。", "item": 3 }
  ],
  "肘上與肘下、可達範圍與奇異點#7": [
   { "say": "這一頁是奇異點的公式和數字。", "item": 0 },
   { "say": "行列式等於 L 一乘 L 二乘 sin theta 二,theta 二接近零度或一百八十度的時候,它就趨近零。", "item": 1 },
   { "say": "目標離肩二十一點九公分的時候,theta 二大約十點九八度,二十二公分的時候是零度。", "item": 2 },
   { "say": "目標只多零點一公分,肘角就要變十點九八度。", "item": 3 }
  ],
  "完整手臂的 IK 與模擬器的 move_to#1": [
   { "say": "好,最後一個單元,是完整手臂的逆運動學,還有模擬器的 move to 函式。", "item": 0 },
   { "say": "真實手臂還有底座旋轉。目標在桌面座標 x、y,高度 z 的時候,有四個步驟。第一步,底座角度 phi,等於 atan2 的 y 和 x。", "item": 1 },
   { "say": "第二步,水平距離 r,等於 x 平方加 y 平方開根號。", "item": 2 },
   { "say": "第三步,在側視平面求解。目標是 r 和 z 減肩高,用二連桿逆運動學,得到 theta 一和 theta 二。肩高就是肩離桌面的高度。", "item": 3 },
   { "say": "第四步,把 phi、theta 一、theta 二,轉成伺服角度,用的是校準的偏移與方向,並且檢查限位。", "item": 4 }
  ],
  "完整手臂的 IK 與模擬器的 move_to#2": [
   { "say": "我們來看一個例題,用模擬器的尺寸,兩節都是二十公分,肩高十二公分,桌面目標 x 是十,y 是十五,z 是二。", "item": 0 },
   { "say": "底座角度 phi,是 atan2 的十五和十,等於五十六點三一度。", "item": 1 },
   { "say": "水平距離 r,是根號下十平方加十五平方,等於十八點零三公分。", "item": 2 },
   { "say": "側視目標是十八點零三,和二,算出肩角 a 一是二十九點九六度,肘角 a 二是一百一十七點九五度。", "item": 3 },
   { "say": "下面是用 Python 驗算的程式。", "item": 4 }
  ],
  "完整手臂的 IK 與模擬器的 move_to#3": [
   { "say": "這是驗算 phi 和 r 的程式。", "item": 0 },
   { "say": "先設定 x、y、z 三個值。", "item": 1 },
   { "say": "用 atan2 算出底座角度,轉成度數。", "item": 2 },
   { "say": "用 hypot 算出水平距離。要注意,模擬器的程式環境沒有 hypot,請用數學套件的開根號函式來算。", "item": 3 },
   { "say": "最後印出來,結果是五十六點三一,和十八點零三。", "item": 4 }
  ],
  "完整手臂的 IK 與模擬器的 move_to#4": [
   { "say": "接下來看模擬器的 move to 函式。", "item": 0 },
   { "say": "它就是側視平面的逆運動學,x 是離底座的水平距離,y 是離桌面的高度,內部用肘上解。它有三種報錯。第一,y 小於零,報錯,因為不能穿過桌面。", "item": 1 },
   { "say": "第二,距離超過四十公分,報錯並說明最遠可及。", "item": 2 },
   { "say": "第三,太靠近底座,也就是肘角超過一百五十度,報錯。", "item": 3 },
   { "say": "它不會旋轉底座,底座要用設定零號關節。", "item": 4 },
   { "say": "完整的把方塊抓起來流程,是先轉到方塊的方位,再 move to 水平距離和高度。範例是,底座朝正前方,move to 二十八、二,到達紅色方塊。二十八、二的逆運動學解,是 a 一二十二點三三度,a 二八十三點九七度,和 move to 內部算出的相同。", "item": 4 }
  ],
  "完整手臂的 IK 與模擬器的 move_to#5": [
   { "say": "這是範例的程式。", "item": 0 },
   { "say": "第一行,設定底座朝正前方。", "item": 1 },
   { "say": "第二行,move to 二十八、二,到達紅色方塊,離底座二十八公分,中心高二公分。", "item": 2 }
  ],
  "完整手臂的 IK 與模擬器的 move_to#6": [
   { "say": "既然有 move to,為什麼還要學公式、自己寫逆運動學呢?有四個原因。", "item": 0 },
   { "say": "第一,實體手臂沒有現成的 move to,要自己算。", "item": 1 },
   { "say": "第二,你需要先檢查再動作,知道目標是否可達、角度是否在限位內,還有有哪些解。", "item": 2 },
   { "say": "第三,你需要處理姿態、避障、選解等 move to 不提供的需求。", "item": 3 },
   { "say": "第四,第九章的安全檢查,需要自己的可達性判斷。模擬器單元中,我們會先自己寫逆運動學,用設定關節驗證,再用 move to 對照。", "item": 4 }
  ],
  "完整手臂的 IK 與模擬器的 move_to#7": [
   { "say": "最後,談談在程式中怎麼整合。", "item": 0 },
   { "say": "建議把運動學包成幾個函式,每個函式只做一件事。第一個是檢查可達性與限位。第二個是側視平面的逆運動學,回傳肩角和肘角。第三個是 goto table,輸入桌面座標,換成底座角度,加上側視逆運動學,再送出命令。", "item": 1 },
   { "say": "goto table 的順序是,先檢查可達,再算角度、檢查限位,最後才送出命令。每一層失敗,都要回傳明確的錯誤。", "item": 2 }
  ],
  "closing": [
   { "say": "好,這一章我們學了逆運動學,用餘弦定律算出平面二連桿的解析解,也談了肘上肘下、可達範圍和奇異點,最後把底座旋轉加進來,對應到模擬器的 move to。", "item": 0 },
   { "say": "接下來請完成本章的實作,再做章末小測驗,檢查自己學會了多少。下一章見。", "item": 1, "pause": 1 }
  ]
 }
}
