{
 "byKey": {
  "cover": [
   { "say": "大家好,歡迎回到從無到有打造 A I 機器人,機械手臂版。這一章,我們要讓手臂動得平滑又安全,學軌跡規劃、梯形速度曲線,還有實機上的速度上限。", "item": 0 }
  ],
  "原理:慣性、加速度與梯形速度規劃#1": [
   { "say": "我們先用推購物車,來打個比方。", "item": 0 },
   { "say": "推一台空的購物車很輕鬆,推滿載的就要用力。而且你不可能一瞬間,讓它從靜止到跑起來,必須逐漸用力。物體不願意改變運動狀態的性質,叫做慣性。手臂的連桿和負載也有慣性,伸得越遠,慣性越大。", "item": 1 }
  ],
  "原理:慣性、加速度與梯形速度規劃#2": [
   { "say": "再來看物理原理。", "item": 0 },
   { "say": "直線運動是力等於質量乘加速度。轉動則是,力矩等於轉動慣量,乘上角加速度。質量 m 集中在離轉軸 r 的地方,轉動慣量就是 m 乘 r 的平方。注意 r 是平方,同一個負載伸遠一倍,慣性就變成四倍。", "item": 1 }
  ],
  "原理:慣性、加速度與梯形速度規劃#3": [
   { "say": "這張圖是轉動的力矩公式。", "item": 0 },
   { "say": "圖裡的例子是,質量零點一公斤,在半徑零點二五公尺的地方,轉動慣量是零點零零六二五。如果要以每秒平方一百二十度加速,需要大約零點零一三一牛頓公尺。", "item": 1 }
  ],
  "原理:慣性、加速度與梯形速度規劃#4": [
   { "say": "我們用 Python 驗算這個例子。", "item": 0 },
   { "say": "只是為了把零點一公斤的負載,以每秒平方一百二十度加速,就要額外零點零一三一牛頓公尺,大約零點一三公斤公分,而且還要再加上第一章的重力力矩。這就解釋了,為什麼加速度要有上限,加速度越大,馬達需要的力矩和電流就越大。", "item": 1 }
  ],
  "原理:慣性、加速度與梯形速度規劃#5": [
   { "say": "畫面上是驗算程式的前半段。", "item": 0 },
   { "say": "先匯入數學套件。", "item": 1 },
   { "say": "設定質量零點一公斤,半徑零點二五公尺。", "item": 2 },
   { "say": "轉動慣量,是質量乘半徑平方,等於零點零零六二五。", "item": 3 },
   { "say": "再把每秒平方一百二十度,換成弧度,大約二點零九四。", "item": 4 }
  ],
  "原理:慣性、加速度與梯形速度規劃#6": [
   { "say": "最後一行是印出結果。", "item": 0 },
   { "say": "轉動慣量、角加速度,還有兩者相乘的力矩,分別是零點零零六二五、二點零九四,和零點零一三一。", "item": 1 }
  ],
  "原理:慣性、加速度與梯形速度規劃#7": [
   { "say": "那為什麼要用梯形的速度曲線呢?", "item": 0 },
   { "say": "如果速度一瞬間跳到最大值,加速度就是無限大,力矩也是無限大,機構會抖動,甚至失步。比較合理的做法是限制加速度不超過 a,以固定的 a 加速到最大速度,等速一段,再以負的 a 減速。", "item": 1 },
   { "say": "把速度對時間畫出來,就是梯形。再對時間積分,得到位置,是一條 S 形曲線。圖中也畫出位置、速度、加速度三條曲線,加速度是正負兩段方波,速度是梯形,位置是平滑的 S 形,而加速度切換的瞬間,就是振動的來源。", "item": 1 }
  ],
  "線性插值:從起點到終點走一條路#1": [
   { "say": "好,現在進入線性插值,看看怎麼從起點走到終點。先問,為什麼不能一步跳過去?", "item": 0 },
   { "say": "前面章節,我們學會了算出目標角度。但如果直接把目標角度送給伺服馬達,它會用最快的速度衝過去。結果就是手臂猛然甩動、撞擊物體、電流突然飆高,夾著的物體也會甩落。", "item": 1 },
   { "say": "要讓運動平滑又安全,需要軌跡規劃。把一次大移動,拆成很多小步,每一步只改變一點點,並且控制速度和加速度。", "item": 1 }
  ],
  "線性插值:從起點到終點走一條路#2": [
   { "say": "最基本的工具,是線性插值,英文叫 lerp。", "item": 0 },
   { "say": "在起點 a 和終點 b 之間,用參數 t,從零到一,取中間值。", "item": 1 },
   { "say": "t 等於零,得到起點。t 等於一,得到終點。t 等於零點二五,就是四分之一處。舉例,從零到十,t 是零點二五,就是二點五。把 t 從零逐步增加到一,就得到一串均勻的中間點。", "item": 2 },
   { "say": "程式很簡單,就是 a 加上 b 減 a,再乘 t。", "item": 3 },
   { "say": "用起點二十、終點八十、分成五步,印出來是二十、三十二、四十四、五十六、六十八、八十。每一步間隔固定的時間 dt,例如二十毫秒,也就是五十赫茲,總時間就是步數乘 dt。", "item": 4 }
  ],
  "線性插值:從起點到終點走一條路#3": [
   { "say": "這一頁是剛剛的公式和程式。", "item": 0 },
   { "say": "插值公式是,a 加上 b 減 a,乘 t。", "item": 1 },
   { "say": "下面是同樣意思的函式。", "item": 2 },
   { "say": "起點二十,終點八十。", "item": 3 },
   { "say": "分成五步。", "item": 4 }
  ],
  "線性插值:從起點到終點走一條路#4": [
   { "say": "接著是迴圈的部分。", "item": 0 },
   { "say": "從第零步跑到第五步,每一步的 t 是步數除以總步數,印出插值的結果。", "item": 1 }
  ],
  "線性插值:從起點到終點走一條路#5": [
   { "say": "插值可以在兩種空間做,結果的路徑不同。", "item": 0 },
   { "say": "第一種是關節空間,對每個關節的角度,分別做線性插值。實作簡單,不會遇到逆運動學的奇異問題,所有關節同時開始、同時結束。但末端的路徑一般不是直線,而是一條曲線。", "item": 1 },
   { "say": "第二種是笛卡兒空間,對末端的位置做線性插值,每一個中間點,都用逆運動學算出關節角度。末端走直線,適合貼桌面平移、垂直下降、沿著牆擦拭。缺點是每個點都要算逆運動學,中途可能碰到奇異點或不可達。", "item": 2 },
   { "say": "來看一個數值例子,L 一是十二,L 二是十,肘上,從十八、零,移動到八、十四。起點的逆運動學,theta 一是三十一點五九度,theta 二是負七十點五三度。", "item": 3 },
   { "say": "終點的逆運動學,theta 一是九十八點四八度,theta 二是負八十六點一八度。用關節空間插值的中點,theta 一是六十五點零三度,theta 二是負七十八點三五度,代回正運動學,末端在十四點八、八點五八。", "item": 4 },
   { "say": "笛卡兒直線的中點是十三、七。兩者相距約二點三八公分。也就是用關節插值的話,中途的位置會偏離直線二點四公分,若中間有物體或桌面,可能就撞上了。", "item": 4 }
  ],
  "線性插值:從起點到終點走一條路#6": [
   { "say": "這張圖就是剛剛那個例子。", "item": 0 },
   { "say": "同樣的起點和終點,藍色的直線,是笛卡兒空間插補。橘色的虛線,是關節空間插補。兩者的中點,相距約二點四公分。", "item": 1 }
  ],
  "線性插值:從起點到終點走一條路#7": [
   { "say": "那什麼時候用哪一種呢?", "item": 0 },
   { "say": "自由空間的大移動,例如從休息位置到物體上方,用關節空間,簡單又快速。", "item": 1 },
   { "say": "接近物體、下降夾取、提起,還有貼著桌面平移,用笛卡兒直線,路徑可以預測。", "item": 2 },
   { "say": "如果需要同時抵達,關節插補天然就同步,因為所有關節用同一個 t。", "item": 3 }
  ],
  "速度與加速度限制:梯形速度曲線#1": [
   { "say": "接下來,看速度與加速度限制。先問,為什麼要限制加速度?", "item": 0 },
   { "say": "即使路徑平滑,如果速度一瞬間從零變成最大,等於加速度無限大,伺服馬達電流會暴增、結構會抖動,夾持的物體也會滑落。好的軌跡,要同時限制最大速度 vmax,和最大加速度 a。最常用的設計,就是梯形速度曲線,以固定加速度加速,到最大速度後等速,再以固定加速度減速到停止。", "item": 1 }
  ],
  "速度與加速度限制:梯形速度曲線#2": [
   { "say": "這張圖是梯形速度曲線。", "item": 0 },
   { "say": "上面是速度,從零等加速到最大值,維持等速,再等減速到零。下面是對應的位置曲線,呈 S 形。橘色的虛線,表示距離太短的時候,梯形會變成三角形。", "item": 1 }
  ],
  "速度與加速度限制:梯形速度曲線#3": [
   { "say": "我們來看公式。給定移動距離 D,單位是度,最大角速度 vmax,最大角加速度 a。", "item": 0 },
   { "say": "加速時間 t acc,等於 vmax 除以 a。", "item": 1 },
   { "say": "加速距離 d acc,等於二分之一乘 a 乘加速時間的平方,也就是 vmax 平方,除以兩倍的 a。", "item": 2 },
   { "say": "加速和減速,共用掉兩倍的加速距離,就是 vmax 平方除以 a。", "item": 3 },
   { "say": "情況一,距離夠長,是梯形,條件是 D 大於等於 vmax 平方除以 a。等速距離,是 D 減去 vmax 平方除以 a。等速時間,是等速距離除以 vmax。總時間 T,等於兩倍的加速時間,加等速時間,也等於 D 除以 vmax,加 vmax 除以 a。", "item": 3 }
  ],
  "速度與加速度限制:梯形速度曲線#4": [
   { "say": "這一頁是梯形情況的公式。", "item": 0 },
   { "say": "等速距離,等於 D 減去 vmax 平方除以 a。", "item": 1 },
   { "say": "等速時間,等於等速距離除以 vmax。", "item": 2 },
   { "say": "總時間,等於兩倍的加速時間加等速時間,也就是 D 除以 vmax,加 vmax 除以 a。", "item": 3 }
  ],
  "速度與加速度限制:梯形速度曲線#5": [
   { "say": "情況二,是距離太短,變成三角形。", "item": 0 },
   { "say": "條件是 D 小於 vmax 平方除以 a,到不了最大速度。這時候峰值速度,是 a 乘 D 開根號。", "item": 1 },
   { "say": "到達峰值的時間,是 D 除以 a 開根號,總時間就是它的兩倍。", "item": 2 }
  ],
  "速度與加速度限制:梯形速度曲線#6": [
   { "say": "我們來看數值例題一,梯形的情況。", "item": 0 },
   { "say": "D 是九十度,vmax 是每秒六十度,a 是每秒平方一百二十度。加速時間是六十除以一百二十,零點五秒。加速距離是二分之一乘一百二十乘零點五的平方,十五度。", "item": 1 },
   { "say": "vmax 平方除以 a,是三千六百除以一百二十,三十度,小於九十度,所以是梯形。等速距離是九十減三十,六十度,等速時間是一秒。總時間是零點五加一加零點五,兩秒,也等於九十除以六十,加六十除以一百二十。", "item": 1 }
  ],
  "速度與加速度限制:梯形速度曲線#7": [
   { "say": "這一頁是剛剛的算式。", "item": 0 },
   { "say": "加速時間,六十除以一百二十,是零點五秒。", "item": 1 },
   { "say": "加速距離,是二分之一乘一百二十乘零點五的平方,十五度。", "item": 2 },
   { "say": "vmax 平方除以 a,是三十度,小於九十度,所以是梯形。", "item": 3 },
   { "say": "等速距離是九十減三十,六十度,等速時間是六十除以六十,一秒。", "item": 4 }
  ],
  "實機的平滑運動迴圈與速度上限#1": [
   { "say": "好,最後一個單元,是實機的平滑運動迴圈和速度上限。", "item": 0 },
   { "say": "實機上,我們用固定週期的迴圈,送出軌跡的每一點,每隔 dt,例如二十毫秒,計算一次目標角度並送出。固定週期很重要,速度等於位移除以 dt,週期不穩,速度就不穩。畫面上的函式,先找出移動距離最長的關節,用梯形算出總時間,其他關節按比例。", "item": 0 },
   { "say": "然後進入迴圈,每一步先檢查軟體急停,再算出現在走到的比例,把每個關節的角度送出去,走完就跳出,否則睡一個週期。", "item": 0 },
   { "say": "這裡有四個重點。第一,用單調時間,而不是累計睡眠,可以補償每次迴圈耗時的抖動。", "item": 1 },
   { "say": "第二,每一步都檢查軟體急停,否則一次動作期間無法中止。", "item": 2 },
   { "say": "第三,關節命令一律經過 Joint 的設定函式,裡面含有限位檢查。", "item": 3 },
   { "say": "第四,最後一步要確實送出終點,避免因為浮點誤差,少了一點。", "item": 4 }
  ],
  "實機的平滑運動迴圈與速度上限#2": [
   { "say": "這一頁是控制迴圈的程式碼。", "item": 0 },
   { "say": "先匯入時間套件。", "item": 1 },
   { "say": "週期設定為零點零二秒,也就是五十赫茲。", "item": 2 },
   { "say": "接著是執行軌跡的函式,輸入關節列表、起點、終點、最大速度、加速度,還有軟體急停的檢查函式,結構就是剛剛說的流程。", "item": 3 }
  ],
  "實機的平滑運動迴圈與速度上限#3": [
   { "say": "速度上限,要有三層保護。", "item": 0 },
   { "say": "第一層是軌跡層,最大速度和加速度,在軌跡產生的時候,就限定好。", "item": 1 },
   { "say": "第二層是命令層,在送出角度之前,比較這一步和上一步的差,如果超過最大速度乘 dt,就截斷,防止上層出錯,或外部命令太大。", "item": 2 },
   { "say": "第三層是硬體層,有電源電流限制、保險絲和急停,這是第一、二章的內容。即使上層軟體有 bug,命令層和硬體層仍然能擋住。", "item": 3 }
  ],
  "實機的平滑運動迴圈與速度上限#4": [
   { "say": "這一頁是命令層截斷的程式碼。", "item": 0 },
   { "say": "先算出每一步最大能走的距離,是最大速度乘 dt。", "item": 1 },
   { "say": "再算這一步想走的差,是目標減上一步。", "item": 2 },
   { "say": "如果差的絕對值超過最大步長,就把它限制在最大步長,方向保持不變。", "item": 3 },
   { "say": "最後,真正送出的目標,是上一步加上截斷後的差。", "item": 4 }
  ],
  "實機的平滑運動迴圈與速度上限#5": [
   { "say": "接下來,針對情境調整速度。", "item": 0 },
   { "say": "自由移動,離開人和物體的時候,可以比較快。", "item": 1 },
   { "say": "靠近桌面、物體,或夾取的時候,降速到每秒五到十度。", "item": 2 },
   { "say": "夾著物體的時候,加速度要降低。", "item": 3 },
   { "say": "如果有偵測,有人在緩衝區附近,就降速或停止。", "item": 4 },
   { "say": "測試新程式的時候,全程降到安全速度。", "item": 5 }
  ],
  "實機的平滑運動迴圈與速度上限#6": [
   { "say": "最後談談監看與異常。", "item": 0 },
   { "say": "第一是時序。如果某一步的計算超過 dt,就記錄警告,連續超時就停止。", "item": 1 },
   { "say": "第二是堵轉判斷。實機沒有位置回授的時候,可以從電源電流異常、聲音,或驅動板的過電流指示來判斷,依硬體而異。偵測到,就停止並放鬆。", "item": 2 },
   { "say": "第三是看門狗。控制程式要定期餵狗,如果主程式卡住,另一個執行緒或外部電路,就切斷輸出,依平台而異。", "item": 3 }
  ],
  "實機的平滑運動迴圈與速度上限#7": [
   { "say": "最後,跟模擬器對照一下。", "item": 0 },
   { "say": "模擬器的 move to,是阻塞式的,固定每秒九十度,沒有梯形加減速。要練習平滑,可以在模擬器中,用迴圈實作每一步小位移,加上睡眠,並且自己計算每一步的位置。這跟實機的控制迴圈結構一致,差別在於,實機要處理真實的時間和電流。", "item": 1 }
  ],
  "closing": [
   { "say": "好,這一章我們學了慣性與加速度,線性插值與兩種插值空間,梯形速度曲線,還有實機的平滑運動迴圈和三層速度保護。", "item": 0 },
   { "say": "接下來請完成本章的實作,再做章末小測驗,檢查自己學會了多少。下一章見。", "item": 1, "pause": 1 }
  ]
 }
}
