{
 "byKey": {
  "cover": [
   {
    "say": "大家好,歡迎回到從無到有打造 A I 機器人。這一章,我們要幫機器人裝上感覺。會學到超音波測距、循線感測器、I M U,還有用輪子推算位置的里程計與資料濾波。",
    "item": 0
   }
  ],
  "原理:超音波的飛行時間與紅外線反射#1": [
   {
    "say": "我們先用兩個生活類比,來理解感測器。第一個,山谷裡的回音。",
    "item": 0
   },
   {
    "say": "在山谷對著遠方喊一聲,過幾秒聽到回音。你知道聲音的速度,只要量出喊到聽到的時間,就能估出對面山壁有多遠。",
    "item": 1
   },
   {
    "say": "超音波測距,就是把山谷縮小成幾公尺,把人聲換成人耳聽不到的四十千赫茲聲波。至於循線感測器,則像是用手電筒照地板,白色地板把光反射得多,黑色膠帶吸收得多,看反射光的強弱,就知道腳下是什麼顏色。",
    "item": 1
   }
  ],
  "原理:超音波的飛行時間與紅外線反射#2": [
   {
    "say": "原理一,飛行時間,英文是 Time of Flight。",
    "item": 0
   },
   {
    "say": "聲音往返一趟的時間是 t,距離 d,就等於聲速乘上 t,再除以二。",
    "item": 1
   },
   {
    "say": "除以二,是因為聲音去了又回來。",
    "item": 2
   },
   {
    "say": "聲速不是常數,它會隨空氣溫度改變。近似的算法是,三百三十一點四,加上零點六乘以攝氏溫度。二十度的時候,聲速大約是每秒三百四十三點四公尺。",
    "item": 3
   },
   {
    "say": "來看數值例一。每一公分的距離,對應的往返時間是,二乘零點零一,除以三百四十三,等於五十八點三微秒。所以如果樹莓派的計時抖動有一百微秒,距離就會有大約一點七公分的誤差。這就是第四章說軟體計時有抖動、要濾波的原因。",
    "item": 4
   },
   {
    "say": "數值例二,最遠四公尺的時候,往返時間是二十三點三毫秒。所以兩次量測,至少要間隔數十毫秒,讓回音消散,否則下一次會讀到上一次的回音。",
    "item": 4
   },
   {
    "say": "數值例三,程式固定用每秒三百四十三公尺,但實際是三十度,聲速約三百四十九點四。真實一百公分的地方,程式會算成大約九十八點二公分,誤差約百分之一點八,避障是可以接受的。",
    "item": 4
   }
  ],
  "原理:超音波的飛行時間與紅外線反射#3": [
   {
    "say": "我們把兩個公式列出來。",
    "item": 0
   },
   {
    "say": "距離,等於聲速乘上往返時間,再除以二。",
    "item": 1
   },
   {
    "say": "聲速,大約等於三百三十一點四,加上零點六乘以攝氏溫度,單位是公尺每秒。",
    "item": 2
   }
  ],
  "原理:超音波的飛行時間與紅外線反射#4": [
   {
    "say": "這張圖是聲速隨溫度變化的曲線。",
    "item": 0
   },
   {
    "say": "你可以看到,溫度越高,聲速越快。圖中標出二十度的時候,聲速約三百四十三公尺每秒。圖也說明了,如果程式假設三百四十三,而實際是三十度,那麼量到一百公分的地方,大約會算成九十八點二公分。",
    "item": 1
   }
  ],
  "原理:超音波的飛行時間與紅外線反射#5": [
   {
    "say": "原理二,反射式紅外線。",
    "item": 0
   },
   {
    "say": "循線感測器裡面,有紅外線 L E D 和光接收元件。光打到表面後,一部分被吸收,一部分被反射。白色表面反射多,黑色吸收多,接收元件收到的光不同,電流也不同,比較器再依門檻輸出高或低。",
    "item": 0
   },
   {
    "say": "因此第一個要注意,高度影響很大。離地面太遠,反射光變弱且散開,黑白的差異就縮小了。",
    "item": 1
   },
   {
    "say": "第二,環境光會干擾。強烈的陽光含有大量紅外線,可能讓讀值不穩。",
    "item": 2
   },
   {
    "say": "第三,黑色不一定完全不反射。有些黑色膠帶或地墊會反光,所以要實測。",
    "item": 3
   }
  ],
  "原理:超音波的飛行時間與紅外線反射#6": [
   {
    "say": "這張是反射式紅外線循線的原理圖,請從左往右看。",
    "item": 0
   },
   {
    "say": "左邊是白色的地面,反射很強。中間是黑線,大部分的光被吸收,反射很弱。右邊是感測器離地太高的情況,反射太弱,黑白難以分辨。下方還提醒,輸出的極性依模組而異。",
    "item": 1
   }
  ],
  "原理:超音波的飛行時間與紅外線反射#7": [
   {
    "say": "最後,為什麼會有雜訊與盲區?",
    "item": 0
   },
   {
    "say": "超音波的聲波是錐形擴散的。遇到斜面,或是柔軟的吸音材料,回音可能偏離或消失,所以會有讀不到,或讀得太遠的情況。",
    "item": 1
   },
   {
    "say": "距離太近,大約兩公分以內,發射與接收會重疊,也量不準。",
    "item": 1
   }
  ],
  "超音波測距:原理、讀取與濾波#1": [
   {
    "say": "好,來看超音波測距。為什麼用超音波?",
    "item": 0
   },
   {
    "say": "超音波模組,像 HC-SR04 這一類,價格低、接線簡單,是入門機器人最常用的避障感測器。它的原理像蝙蝠,發出聽不見的聲波,聽回音,計算聲音往返的時間。",
    "item": 1
   }
  ],
  "超音波測距:原理、讀取與濾波#2": [
   {
    "say": "這張是超音波的時序示意圖。",
    "item": 0
   },
   {
    "say": "先看 TRIG 腳位,送出一個大約十微秒的高電位脈衝。接著模組發射聲波。ECHO 腳位的高電位持續時間,就等於聲音往返的時間。最後,距離等於時間乘以聲速,再除以二。",
    "item": 1
   }
  ],
  "超音波測距:原理、讀取與濾波#3": [
   {
    "say": "我們把時序一步一步整理起來。",
    "item": 0
   },
   {
    "say": "第一步,程式讓 TRIG 輸出至少十微秒的高電位,觸發一次量測。",
    "item": 1
   },
   {
    "say": "第二步,模組發出一串四十千赫茲的聲波。",
    "item": 2
   },
   {
    "say": "第三步,ECHO 腳位在等待回音的期間輸出高電位,高電位持續的時間 t,就是聲音往返的時間。",
    "item": 3
   },
   {
    "say": "第四步,距離等於 t 乘上聲速,再除以二。聲速約每秒三百四十三公尺,是在大約二十度的空氣中,溫度越高越快。",
    "item": 4
   },
   {
    "say": "舉個例題,ECHO 高電位持續二點九毫秒,距離就是零點零零二九乘三百四十三,除以二,等於零點四九七公尺,大約五十公分。另外有個速記法,距離的公分數,大約等於微秒數除以五十八。",
    "item": 4
   }
  ],
  "超音波測距:原理、讀取與濾波#4": [
   {
    "say": "剛剛那題的算式,在這裡。",
    "item": 0
   },
   {
    "say": "距離等於零點零零二九,乘三百四十三,除以二,等於零點四九七公尺,大約五十公分。",
    "item": 1
   }
  ],
  "超音波測距:原理、讀取與濾波#5": [
   {
    "say": "接下來,用 gpiozero 來讀取。",
    "item": 0
   },
   {
    "say": "先看 max distance,它是最大量測距離,單位是公尺。回傳值超出範圍的時候,會回報最大距離。",
    "item": 1
   },
   {
    "say": "程式第一行,從 gpiozero 匯入 DistanceSensor。",
    "item": 2
   },
   {
    "say": "接著建立一個 sonar,指定 echo 接第二十四號腳位,trigger 接第二十三號腳位,最大距離兩公尺。腳位以你的板子與程式碼為準。",
    "item": 3
   },
   {
    "say": "然後把 distance 乘一百,換成公分,因為 distance 的單位是公尺。",
    "item": 4
   },
   {
    "say": "最後把前方的距離印出來,取到小數點後一位。要特別提醒,Echo 腳位一定要分壓到三點三伏特,第二章講過,否則可能損壞 G P I O。",
    "item": 5
   }
  ],
  "超音波測距:原理、讀取與濾波#6": [
   {
    "say": "這張是感測器的視野示意圖。",
    "item": 0
   },
   {
    "say": "車頭前方的超音波,視野是一個窄窄的錐形。三個循線感測器,則位在車底的前緣。下方的黑線,代表地面的軌道。",
    "item": 1
   }
  ],
  "超音波測距:原理、讀取與濾波#7": [
   {
    "say": "超音波有幾項限制,要先知道。",
    "item": 0
   },
   {
    "say": "第一是盲區,太近,大約兩公分以內,量不準。",
    "item": 1
   },
   {
    "say": "第二是視野,它是窄錐形,大約十五到三十度,依模組而異。窄的物體,像是椅腳,可能偵測不到。",
    "item": 2
   },
   {
    "say": "第三是斜面與吸音材料。聲波斜著打到牆壁,會反射到別處,毛料和海綿會吸收聲音,導致讀值偏遠,或是超出範圍。",
    "item": 3
   },
   {
    "say": "第四是雜訊與抖動。軟體計時在樹莓派忙碌的時候會有誤差,偶爾出現極端值,像是零,或是最大值。",
    "item": 4
   },
   {
    "say": "第五是多感測器串擾。多個超音波同時發射,可能互相干擾。",
    "item": 5
   }
  ],
  "循線感測器與 IMU#1": [
   {
    "say": "接下來是循線感測器與 I M U。先看循線感測器的原理、極性與讀取。",
    "item": 0
   },
   {
    "say": "常見的三路循線模組,使用反射式紅外線,發射紅外光到地面,再用接收元件看反射多少。白色地面反射強,黑色線條吸收光、反射弱。",
    "item": 1
   },
   {
    "say": "模組上通常有一個比較器和可調電阻,把類比的反射量,轉成黑或白的數位輸出。三個感測器排在車底前緣,分別看到左、中、右。",
    "item": 1
   },
   {
    "say": "要注意極性。有些模組偵測到黑線時輸出高電位,有些輸出低電位,所以零是黑還是白,取決於你的零件。",
    "item": 2
   },
   {
    "say": "不要假設,要實測。把感測器分別放在白紙和黑色膠帶上,記錄讀值,然後在程式裡統一轉成,一代表黑線,零代表白,這和模擬器 robot 點 line 的約定一致。",
    "item": 3
   },
   {
    "say": "gpiozero 也有 LineSensor 類別,但是它的極性和平滑行為,依版本與零件而異,新手建議先用 DigitalInputDevice 看原始值。",
    "item": 3
   }
  ],
  "循線感測器與 IMU#2": [
   {
    "say": "實測的程式,畫面上是這幾行,意思如下。",
    "item": 0
   },
   {
    "say": "先匯入 DigitalInputDevice。",
    "item": 1
   },
   {
    "say": "再建立一個字典,記錄左、中、右三個感測器,分別用第十七、第二十七和第二十二號腳位。",
    "item": 2
   },
   {
    "say": "然後替每一個腳位,建立一個輸入裝置。",
    "item": 3
   },
   {
    "say": "最後把三個感測器的值印出來。你可以把感測器放在白紙和黑膠帶上,各跑一次,看讀值怎麼變。可調電阻可以調整靈敏度,要在實際的地板和膠帶上調到黑白分明。環境光與地板顏色,像是木紋、反光,都會影響。",
    "item": 4
   }
  ],
  "循線感測器與 IMU#3": [
   {
    "say": "還有兩件事。第一個是感測器的高度。",
    "item": 0
   },
   {
    "say": "反射式感測器離地面太高或太低都會失效,多半要在一到兩公分之間,依模組資料表為準。",
    "item": 1
   },
   {
    "say": "第二個,I M U,中文叫慣性測量單元,用來量測車子的轉動。像 MPU6050 這一類,包含三軸陀螺儀,量角速度,還有三軸加速度計。",
    "item": 2
   }
  ],
  "循線感測器與 IMU#4": [
   {
    "say": "I M U 用 I 平方 C 連線。我們先確認連線有沒有成功。",
    "item": 0
   },
   {
    "say": "先在系統啟用 I 平方 C,可以用 raspi-config 設定。",
    "item": 1
   },
   {
    "say": "然後掃描 I 平方 C 的匯流排一號,如果在表格裡看到 I M U 的位址,就表示找到裝置。如果顯示兩個 U,代表這個位址已經被核心驅動占用了。",
    "item": 2
   },
   {
    "say": "先安裝 i2c-tools 這個套件。",
    "item": 3
   },
   {
    "say": "再執行 i2cdetect 掃描匯流排。",
    "item": 4
   },
   {
    "say": "MPU6050 有個 WHO AM I 暫存器,預設會回傳它自己的識別值,可以用 i2cget 讀。有些仿製晶片會回傳不同的值,請以你的零件為準。",
    "item": 5
   }
  ],
  "循線感測器與 IMU#5": [
   {
    "say": "接下來,用 Python 讀取陀螺儀。暫存器位址,要依 MPU6050 的資料表。",
    "item": 0
   },
   {
    "say": "電源管理暫存器,開機是睡眠狀態,要寫入零把它喚醒。另外,Z 軸陀螺儀的資料,放在高位元組的暫存器裡。預設量程是正負二百五十度每秒的時候,靈敏度是每度每秒一百三十一個單位。使用的是 smbus2 函式庫,套件名稱依系統而異。",
    "item": 1
   },
   {
    "say": "函式裡的做法是,一次讀兩個位元組,高位元組左移八位,再加上低位元組,合成一個十六位元的數字。如果數字大於等於三萬兩千七百六十八,要減掉六萬五千五百三十六,把它轉成負數。最後除以一百三十一,就得到每秒幾度的角速度。",
    "item": 2
   }
  ],
  "循線感測器與 IMU#6": [
   {
    "say": "程式分兩頁看,先是前半段。",
    "item": 0
   },
   {
    "say": "匯入 smbus2 和 time 這兩個模組。",
    "item": 1
   },
   {
    "say": "開啟 I 平方 C 匯流排一號。",
    "item": 2
   },
   {
    "say": "設定 I M U 的位址。",
    "item": 3
   },
   {
    "say": "然後往電源管理暫存器寫入零,把 I M U 從睡眠中喚醒。",
    "item": 4
   }
  ],
  "循線感測器與 IMU#7": [
   {
    "say": "後半段,是讀取 Z 軸角速度的函式 gyro z,做法剛剛已經說明過。",
    "item": 0
   },
   {
    "say": "它讀兩個位元組,合成一個帶正負號的數字,再除以靈敏度,回傳的單位是度每秒。",
    "item": 1
   }
  ],
  "里程計與資料濾波#1": [
   {
    "say": "最後一個單元,里程計與資料濾波。什麼是里程計?",
    "item": 0
   },
   {
    "say": "里程計,英文 odometry,是用輪子轉了多少,推算車子現在在哪裡的方法,又叫航位推算。起點當作座標零零,朝向零度,之後每個時間步更新位置。它不需要外部定位,但是誤差會累積。",
    "item": 1
   }
  ],
  "里程計與資料濾波#2": [
   {
    "say": "這張是里程計的幾何示意圖。",
    "item": 0
   },
   {
    "say": "圖中,車子從舊位置走到新位置,走過的距離是 Δs,航向變化是 Δθ。右側列出了更新 x、y、θ 的公式。",
    "item": 1
   }
  ],
  "里程計與資料濾波#3": [
   {
    "say": "看公式。每個小時間步,從左右輪走過的距離,分別是 ΔsL 和 ΔsR,可以得到下面的結果。",
    "item": 0
   },
   {
    "say": "走過的距離 Δs,是左右輪距離的平均。航向的變化 Δθ,是右輪減左輪的距離,除以輪距。x 加上 Δs 乘以角度的餘弦,y 加上 Δs 乘以角度的正弦,角度再加上 Δθ。",
    "item": 1
   },
   {
    "say": "這裡的角度,用的是舊角度加上 Δθ 的一半,也就是中間角度,比直接用舊角度更準。",
    "item": 2
   }
  ],
  "里程計與資料濾波#4": [
   {
    "say": "公式逐條列出來。",
    "item": 0
   },
   {
    "say": "Δs,等於 ΔsR 加 ΔsL,除以二。",
    "item": 1
   },
   {
    "say": "Δθ,等於 ΔsR 減 ΔsL,除以 L,L 是輪距,單位和 Δs 相同。",
    "item": 2
   },
   {
    "say": "x 更新成,x 加上 Δs,乘以 θ 加 Δθ 的一半的餘弦。",
    "item": 3
   },
   {
    "say": "y 更新成,y 加上 Δs,乘以 θ 加 Δθ 的一半的正弦。",
    "item": 4
   },
   {
    "say": "θ 更新成,θ 加上 Δθ。",
    "item": 5
   }
  ],
  "里程計與資料濾波#8": [
   {
    "say": "如果沒有編碼器怎麼辦?本課程的基本套件沒有編碼器,可以用兩種替代方法。",
    "item": 0
   },
   {
    "say": "第一種,以命令速度估算。用第三章量到的 duty 對應公分每秒的表,預估 Δs 等於速度乘以 dt。這是開迴路的估計,左右輪打滑時,誤差會比較大。",
    "item": 1
   },
   {
    "say": "第二種,用 I M U 的 yaw,取代右輪減左輪再除以輪距算出的 Δθ,再用估計的 Δs。航向由 I M U 提供,通常比輪速差更準。",
    "item": 2
   },
   {
    "say": "如果有編碼器,每個脈衝代表固定的距離,Δs 直接由計數換算,精度更好。例如輪子直徑六點五公分,編碼器每圈二十個脈衝,每個脈衝大約是圓周率乘六點五,除以二十,約一點零二公分。",
    "item": 2
   }
  ],
  "里程計與資料濾波#9": [
   {
    "say": "把剛才的公式,寫成 Python 程式。",
    "item": 0
   },
   {
    "say": "這段程式裡,x、y 和 theta 是全域變數,一開始都是零,theta 的單位是弧度。",
    "item": 1
   },
   {
    "say": "更新里程計的函式,接收左右輪走的距離,和輪距。",
    "item": 2
   },
   {
    "say": "函式裡,先算出平均距離和角度變化,再依照剛剛的公式更新 x、y 和 theta。",
    "item": 3
   },
   {
    "say": "在模擬器裡,robot 點 position 提供類似的資訊,有極小的漂移,robot 點 heading 則提供 I M U 的航向。",
    "item": 4
   }
  ],
  "里程計與資料濾波#10": [
   {
    "say": "最後來看里程計的誤差來源。",
    "item": 0
   },
   {
    "say": "輪子打滑、輪徑誤差、輪距誤差,都會累積成位置誤差。例如輪徑六點五公分,誤差百分之一,走五公尺就差大約五公分。",
    "item": 1
   },
   {
    "say": "角度誤差的影響最大。一度的航向誤差,走兩公尺之後,位置會偏三點五公分左右。",
    "item": 2
   },
   {
    "say": "所以里程計適合短距離、短時間使用。長時間要靠感測器,像是相機、地標來修正。",
    "item": 3
   }
  ],
  "closing": [
   {
    "say": "這一章先到這裡。我們學了超音波的飛行時間、循線感測器的極性、I M U 的讀取,還有里程計和它的誤差來源。",
    "item": 0
   },
   {
    "say": "接下來,請完成實作,再做章末小測驗,看看自己學會了多少。我們下一章見!",
    "item": 1,
    "pause": 1
   }
  ]
 }
}