三個座標系與一條方程式

一個 LiDAR 回波可以寫成三個量:距離 rr、光束方向(由方位角與仰角決定的單位向量 d\mathbf d),以及量測時刻 tt。前兩者給出感測器座標系(sensor frame)中的點 ps=r d\mathbf p_s=r\,\mathbf d;時間 tt 則決定稍後要用哪一個位姿,把這個點搬到地圖上。

要把 ps\mathbf p_s 放進地圖,還要經過兩個座標系。機體座標系(body frame)固定在載具或手持設備上,常取 IMU 的座標系,隨平台一起移動。世界座標系(world / map frame)是整張地圖共用的座標;它可能只是由建圖起點定義的區域座標,不一定是工地的測量座標。三者的關係是:

p~w=Twb(t) Tbs p~s,p~=[p1]\tilde{\mathbf p}_w=\mathbf T_{wb}(t)\,\mathbf T_{bs}\,\tilde{\mathbf p}_s,\qquad \tilde{\mathbf p}=\begin{bmatrix}\mathbf p\\ 1\end{bmatrix}

記號 Tab\mathbf T_{ab} 表示把 b 座標系中的座標轉換到 a 座標系,p~\tilde{\mathbf p} 是補上 1 的齊次座標(homogeneous coordinates)。Tbs\mathbf T_{bs} 是外參(extrinsic parameters):感測器相對機體的位置與姿態,由校正取得,在一次作業中通常視為常數。Twb(t)\mathbf T_{wb}(t) 是機體在時刻 tt 的位姿(pose),也就是 SLAM 要估計的軌跡。點雲中的每一個點,都是這條方程式的一次計算結果。

圖 F-01三個座標系與一條轉換鏈
世界、機體與感測器三個座標系示意 世界座標系 W 固定於左下方;機體座標系 B 位於一條虛線估計軌跡上,以 T_wb(t) 表示它在時刻 t 相對 W 的位姿;感測器座標系 S 固定在機體上,兩者之間的轉換 T_bs 為外參;感測器沿方向 d 發出光束,在距離 r 處打到右側牆面,得到點 p,牆面上另有數個已量到的點。 估計軌跡W 世界(地圖)Twb(t)B 機體(IMU)TbsS 感測器r · dp
  1. 1量測

    ps=r d\mathbf p_s=r\,\mathbf d

    感測器座標系中的點:距離 rr、光束方向 d\mathbf d,另帶一個時間戳記 tt。

    誤差:測距雜訊與偏差、方向誤差見量測本身

  2. × Tbs\times\,\mathbf T_{bs}

    外參:感測器相對機體的位姿,由校正取得,作業中通常視為常數

    誤差見外參校正

  3. 2機體座標

    pb=Tbs ps\mathbf p_b=\mathbf T_{bs}\,\mathbf p_s

    同一點改以機體(常取 IMU)座標表示,仍隨平台移動。

  4. × Twb(t)\times\,\mathbf T_{wb}(t)

    軌跡:機體在該點量測時刻的位姿,由 SLAM 估計,理想上逐點依時間戳記取值

    誤差見時間同步、掃描內運動、軌跡漂移(見 F-03)

  5. 3世界座標

    pw=Twb(t) pb\mathbf p_w=\mathbf T_{wb}(t)\,\mathbf p_b

    地圖上的點。上游每一項誤差都已寫進這個座標,事後無法從單一點分辨來源。

剛體轉換與 SE(3)

方程式中的每個 T\mathbf T 都是一個剛體轉換:

T=[Rt0⊤1]∈SE(3),R∈SO(3),  t∈R3\mathbf T=\begin{bmatrix}\mathbf R & \mathbf t\\ \mathbf 0^{\top} & 1\end{bmatrix}\in SE(3),\qquad \mathbf R\in SO(3),\ \ \mathbf t\in\mathbb R^{3}

R\mathbf R 是旋轉矩陣(R⊤R=I\mathbf R^{\top}\mathbf R=\mathbf I、det⁡R=1\det\mathbf R=1),t\mathbf t 是平移向量;三維剛體轉換共有六個自由度,三個旋轉、三個平移。把方程式展開,可以看清楚每一項從哪裡進來:

pw=Rwb(t)(Rbs r d+tbs)+twb(t)\mathbf p_w=\mathbf R_{wb}(t)\bigl(\mathbf R_{bs}\,r\,\mathbf d+\mathbf t_{bs}\bigr)+\mathbf t_{wb}(t)

旋轉矩陣的集合不是向量空間:兩個旋轉不能直接相加,平均與內插也要另外定義。因此狀態估計通常在位姿所構成的群上定義小擾動與不確定度;Barfoot 的教科書以矩陣李群(matrix Lie group)系統整理了這套工具(本站只讀了該書部分章節,李群一章依目錄核對)(Barfoot, 2017);本站讀過的第 8 至 10 章相關小節把這套工具用於點雲對齊、位姿圖鬆弛與連續時間估計,位姿問題以 SE(3) 上的 Gauss-Newton 迭代求解(Barfoot, 2017, Ch. 8 to 10)。本頁只需要其中一個直覺:旋轉誤差對點的影響,與點到旋轉中心的距離成正比。

誤差如何沿方程式傳遞

對展開式取一階近似,可以把點的誤差分成三類。這是剛體運動學的一般推導,不是特定文獻的結果:

δpw≈δt⏟(1)+ϵ×rw⏟(2)+Rws(δr d+r δd)⏟(3)\delta\mathbf p_w\approx\underbrace{\delta\mathbf t}_{(1)}+\underbrace{\boldsymbol\epsilon\times\mathbf r_w}_{(2)}+\underbrace{\mathbf R_{ws}\bigl(\delta r\,\mathbf d+r\,\delta\mathbf d\bigr)}_{(3)}
  • (1) 平移誤差 δt\delta\mathbf t:機體位置誤差與外參平移誤差。它讓以同一位姿投影的所有點偏移同一個量,與距離無關。
  • (2) 旋轉誤差:ϵ\boldsymbol\epsilon 是機體姿態誤差與外參旋轉誤差的合成(小角度,以弧度計),rw\mathbf r_w 是感測器指向該點的向量。位移大小至多約為 r ∣ϵ∣r\,|\boldsymbol\epsilon|(轉軸與光束垂直時取最大值),距離就是槓桿臂(lever arm)。這裡假設感測器與機體原點的距離遠小於測距。
  • (3) 量測誤差:測距誤差 δr\delta r 沿著光束方向;方向誤差造成的位移 r δdr\,\delta\mathbf d 垂直於光束,同樣隨距離放大。

以數字感受槓桿臂:0.1° 的旋轉誤差約等於 1.75 mrad;轉軸與光束垂直時,它在 10 m 處造成約 1.7 cm 的位移,在 30 m 處約 5.2 cm;同樣的平移誤差則不論遠近都一樣大。

時間誤差不是第四類,而是透過 (1) 與 (2) 表現:若一個點的時間戳記偏差 Δt\Delta t,就會用錯時刻的位姿投影(下式左半)。平台以速度 v\mathbf v、角速度 ω\boldsymbol\omega 運動時,一階近似為:

Twb(t)  →  Twb(t+Δt)  ⟹  δt≈v Δt,    ϵ≈ω Δt\mathbf T_{wb}(t)\;\rightarrow\;\mathbf T_{wb}(t+\Delta t)\;\Longrightarrow\;\delta\mathbf t\approx\mathbf v\,\Delta t,\;\;\boldsymbol\epsilon\approx\boldsymbol\omega\,\Delta t

下方互動圖在 2D 俯視平面中把 (1) 與 (2) 分開:可以只加入航向誤差、只加入位置誤差,或再加上固定的外參旋轉偏差,觀察同一組誤差在不同距離的點上造成多大位移。

互動 F-01a位姿誤差如何放大成點的誤差:槓桿臂效應教學模擬 · 非實測資料
俯視圖誤差放大
5 m10 m20 m
  • 牆面(真實幾何)
  • 以真實位姿投影的點
  • 以誤差位姿投影的點(誤差位姿 ×10 繪製)
  • 誤差向量
  • 距感測器 5、10、20 m
  • 選定光束的角度項
  • 選定光束的平移項
  • 真實與誤差感測器位姿

位移量 |δp| 與距離 r(實際值,未放大)

r*0510152025010203040距離 r(m)|δp|(cm)
  • 各光束的實際 |δp|
  • 角度項 2r·|sin(α/2)|
  • 平移項 |δt|
  • 任意方位的 |δp| 範圍(I 形標出 5、10、20 m)

誤差怎麼傳到點上

δp=p^−p=(R(α)−I) p+δt\delta\mathbf{p}=\hat{\mathbf{p}}-\mathbf{p}=\bigl(\mathbf{R}(\alpha)-\mathbf{I}\bigr)\,\mathbf{p}+\delta\mathbf{t}
∣δp∣≈∣ δt+r α u⊥∣|\delta\mathbf{p}|\approx\bigl|\,\delta\mathbf{t}+r\,\alpha\,\mathbf{u}_{\perp}\bigr|

α\alpha 為作用在點上的角度誤差(弧度),不勾選外參時 α=δθ\alpha=\delta\theta,勾選後 α=δθ+δφ\alpha=\delta\theta+\delta\varphi;rr 為感測器到點的距離; u⊥\mathbf{u}_{\perp} 為垂直於光束的單位向量(光束方向逆時針轉 90°)。第一式為精確式,第二式取 sin⁡α≈α, cos⁡α≈1\sin\alpha\approx\alpha,\ \cos\alpha\approx 1。

∣ ∣δt∣−a ∣  ≤  ∣δp∣  ≤  ∣δt∣+a\bigl|\,|\delta\mathbf{t}|-a\,\bigr|\;\le\;|\delta\mathbf{p}|\;\le\;|\delta\mathbf{t}|+a
a=2r ∣sin⁡(α/2)∣≈r∣α∣a=2r\,\bigl|\sin(\alpha/2)\bigr|\approx r|\alpha|

aa 為角度項的長度(精確式),與 rr 成正比(距離就是槓桿臂);平移項與 rr 無關。上界出現在兩項同向的方位,下界出現在兩項反向的方位。兩項相等的交叉距離 r∗≈∣δt∣/∣α∣r^{*}\approx|\delta\mathbf{t}|/|\alpha|;超過 r∗r^{*} 後角度項主導。

有效角度誤差 α = 0.50°角度項斜率 每公尺 0.87 cm平移誤差 |δt| = 5.0 cmr = 5 m:|δp| 0.6 至 9.4 cmr = 10 m:|δp| 3.7 至 13.7 cmr = 20 m:|δp| 12.5 至 22.5 cm交叉距離 r* = 5.7 m 選定光束 β = 15°:r = 25.9 m,|δp| = 24.9 cm(角度項 22.6、平移項 5.0 cm)

觀察重點:(1)按「只有航向誤差」:每條誤差向量都近乎垂直於光束,長度與距離成正比,20 m 處的位移是 10 m 處的兩倍,位移圖中的點落在一條通過原點的直線上。(2)按「只有位置誤差」:所有點都平移同一個 δt,與距離無關,位移圖中是一條水平線。(3)兩者並存時,同一距離的位移依光束方位而異,兩項同向時相加、反向時互相抵銷,因此落在色帶內;距離超過交叉距離 r* 後,角度項主導。(4)勾選外參誤差:LiDAR 相對 IMU 的旋轉偏差與航向誤差在點上以相同方式疊加(α = δθ + δφ),同樣隨距離放大;在這個單一掃描中,無法只憑點的位移分辨兩者。讀數「|δp| a 至 b cm」指距感測器 r 公尺、任意方位(0° 至 360°)的點其 |δp| 的解析最小值至最大值,不限於本房間牆面實際打到的光束;r* 為角度項 2r·|sin(α/2)| 等於 |δt| 的距離。這兩者是本模擬的幾何量,並非標準化的點雲品質指標。

簡化條件:2D 俯視、單一掃描、剛體位姿誤差;感測器原點與機體原點重合(外參只含旋轉,不含平移),外參旋轉 δφ 固定為 0.5°,為模擬設定值;不含測距雜訊、光束角度誤差、掃描期間運動造成的畸變與時間同步誤差。近似式 |δp| ≈ |δt + r·α·u⊥| 採小角度近似,與精確值的差約為 r·α²/2(α 以弧度計);位移圖、讀數與俯視圖一律使用精確式。俯視圖以放大後的 δθ、δt、δφ 繪製誤差位姿,僅為便於觀看;位移圖與讀數皆為實際值。

互動圖說明的第 4 點指出,在單一掃描中,外參旋轉偏差與機體航向誤差對點的作用方式相同,只看點的位移無法分辨兩者(教學模擬)。

外參校正:感測器相對機體的位姿從哪裡來

本站已查證的 LiDAR 與 IMU 外參校正文獻,多是從運動中的感測資料本身估計外參;其中 LI-Calib 與 LI-Init 以設備 CAD 圖推得的相對位姿作為比較參考(Lv et al., 2020; Zhu et al., 2022b)。三個代表方法的作法與報告結果如下。

LI-Calib 以連續時間(continuous-time) B 樣條表示 IMU 軌跡,使每個 LiDAR 點的取樣時刻都能取得位姿,再以原始加速度與角速度殘差和點到面元(surfel)的距離聯合最佳化外參;過程中反覆去畸變、重建面元地圖並更新對應(Lv et al., 2020)。作者假設兩感測器已硬體同步,不估計兩者的時間偏移(time offset)(Lv et al., 2020, Sec. V)。模擬中 10 組蒙地卡羅序列的平移誤差為 0.0043 ± 0.0006 m、旋轉誤差為 0.0224 ± 0.0026°(Lv et al., 2020, Sec. V-A);實測中室內校正的重複性優於室外,作者歸因於室內平面較多(Lv et al., 2020, Sec. V-B)。作者也指出,方法需要足夠的旋轉與平移激勵,首輪 NDT 里程計不佳時,對應關係與校正結果都會失準(Lv et al., 2020, Sec. V-B, VI)。

Le Gentil 等強調 LiDAR 點是逐點取樣而非快照。他們以高斯過程迴歸對 IMU 讀數上取樣,為每個點計算預積分量以去畸變,並聯合估計外參、IMU 狀態與時間偏移;模擬顯示不使用逐點上取樣預積分時,快速運動下的校正精度明顯下降(Le Gentil et al., 2018, Sec. IV-A4)。實測資料只有一段在房間牆角前的 60 s 序列,且沒有真值;結果與串接 Kalibr 的 IMU 與相機、相機與 LiDAR 校正相差 3.6 cm 與 1.45°,因此這項比較不具決定性(Le Gentil et al., 2018, Sec. IV-B)。

LI-Init 在 LiDAR 慣性里程計啟動前判斷資料激勵是否足夠,並線上估計時間偏移、外參、重力向量與 IMU 偏差(Zhu et al., 2022b)。作者把 IMU 時間戳記人為平移 0.05 至 0.5 s 後,在 Livox 感測器上估得的時間偏移 RMSE 約 1.6 至 3.4 ms(Zhu et al., 2022b, Table II);這些 Livox 的內建 IMU 原本已由原廠硬體同步,未同步的設備則沒有時間偏移真值,只能透過里程計漂移間接檢驗(Zhu et al., 2022b, Sec. IV-A)。三款 LiDAR 的外參平移誤差相對 CAD 參考平均約 0.6 至 1.3 cm(Zhu et al., 2022b, Table III),這個參考是兩個 Pixhawk 安裝位置之間的 CAD 設計相對位姿,屬間接驗證(Zhu et al., 2022b, Sec. IV-B)。方法假設時間偏移未知但固定(Zhu et al., 2022b, Sec. I)。

三篇都把去畸變放進校正流程。LI-Calib 與 Le Gentil 等以 IMU 軌跡為每個點去畸變,因此校正需要去畸變後的點,而去畸變又需要外參(Lv et al., 2020; Le Gentil et al., 2018);LI-Init 在初始化階段則不使用尚未同步的 IMU,改以等速預測把每個點投影到掃描結束時刻(Zhu et al., 2022b, Sec. III-B.2)。Le Gentil 等與 LI-Init 另把時間偏移納入同一估計,LI-Calib 則假設已硬體同步(Le Gentil et al., 2018; Zhu et al., 2022b; Lv et al., 2020)。三者的驗證都在模擬或受控實驗中進行,沒有一篇在營建工地驗證。

營建相關的紀錄只觸及外參的前提。Nubert 等為大型步行式挖掘機融合 IMU、LiDAR 與 RTK-GNSS,全文假設外參已知(Nubert et al., 2022a, Sec. III-A),並指出大型機具上難以取得精確的外參校正,會使融合結果變差(Nubert et al., 2022a, Sec. V);外參與時間偏移的聯合估計留待未來研究(Nubert et al., 2022a, Sec. VI)。在部分序列錄製於施工中工地的 Hilti-Oxford 資料集中,作者說明設備雖採高精度加工件,但未另行校正 LiDAR 與 IMU 之間的外參,可能使真值控制點帶有數毫米誤差(Zhang et al., 2023c, Sec. VI-C)。

若點雲要著色,或要與影像一起量測,還需要 LiDAR 與相機之間的外參。Yuan 等以自然場景中的邊緣特徵對齊兩者,並依 LiDAR 量測原理指出,深度不連續的邊緣受前景與背景混合影響而不可靠,因此改用深度連續的邊緣(Yuan et al., 2021, Sec. III)。

時間同步:每個點用哪一刻的位姿

方程式中的 tt 必須和軌跡使用同一個時鐘。LiDAR、IMU、相機與電腦各有時鐘;若時間戳記是在資料抵達主機時才標上,傳輸與排程造成的延遲與抖動都會變成時間誤差。Olson 指出,許多常見的商用感測器不支援同步,只能在資料抵達主機時標上時間戳記;經 USB 轉序列埠連接的 LiDAR 與 IMU 也會引入可變延遲,而以每秒 90° 旋轉時,10 ms 的同步誤差就會使 10 m 外物體的投影偏移 15.7 cm(Olson, 2010, Sec. I)。他提出不需感測器配合的被動同步演算法:利用延遲不可能為負的因果關係,搭配感測器時鐘速率漂移的上界模型,估計感測器與主機時鐘的偏移,再還原每筆資料的主機時間,並證明結果不會劣於直接以抵達時間標記的作法(Olson, 2010, Sec. III-B to III-D)。不過該文的實驗只使用合成的時間資料,且感測器時鐘漂移越大,效果越接近未做同步修正的情況(Olson, 2010, Sec. IV, Fig. 6)。

Faizullin 等以微控制器模擬 GNSS 時鐘(PPS 與 NMEA 訊息),輸入 VLP-16 的硬體同步介面,無需實體 GNSS 接收器。以時間戳記週期的標準差衡量精密度:ROS 抵達時間戳記為 82.64 µs,該系統為 1.35 µs(Faizullin et al., 2022, Table I);約 10 µs 的同步準確度是依感測器文件推估,作者說明實測準確度不在該文範圍內(Faizullin et al., 2022, Sec. IV)。

另一條路線是把時間偏移當作未知數來估計。Furgale 等以連續時間 B 樣條表示 IMU 位姿與偏差,把相機與 IMU 之間的固定時間偏移直接寫入影像量測模型,與外參、重力方向及 IMU 偏差一起做最大概似批次估計(Furgale et al., 2013, Sec. III, IV);在 40 組實測資料中,估得的偏移對曝光時間的斜率為 0.498(理論值 0.5),各組與擬合線的差異都在 ±0.2 ms 內,約為 IMU 5 ms 取樣週期的 4%;由於沒有真實延遲可比對,這項準確度是以理論斜率間接判斷(Furgale et al., 2013, Sec. V-B, Fig. 5)。Rehder 等把感測器間的固定時間偏移視為確定性誤差,在同類的連續時間批次估計中推導相機、IMU 與 2D 雷射測距儀等多種組合的估計器(Rehder et al., 2016, Sec. III, Table I);硬體同步時估得的雷射測距儀偏移為 2.603 ± 0.045 ms,接近產品規格的 2.725 ms,改以軟體同步的結果也與硬體同步相近(Rehder et al., 2016, Table III, Sec. IV-E)。Li 與 Mourikis 把相機與 IMU 的時間偏移納入 EKF 狀態線上估計,並證明除零角速度、等角速度或加速度計讀值固定等少數退化運動外,偏移都是局部可辨識的(Li & Mourikis, 2014, Sec. 4, 6.4, 6.5)。Furgale 等與 Li 與 Mourikis 只處理相機與 IMU,Rehder 等的雷射部分也只有 2D 測距儀;3D LiDAR 的時間偏移估計證據主要來自前節的 LI-Init 與 Le Gentil 等(Zhu et al., 2022b; Le Gentil et al., 2018)。

時間偏移也會影響去畸變。LI-Init 作者指出,時間偏移未知時,依賴 IMU 的運動畸變補償無法正確執行(Zhu et al., 2022b, Sec. I);Point-LIO 的官方程式說明文件也要求 LiDAR 與 IMU 已同步,且點雲帶有逐點時間戳記(He et al., 2023a, GitHub README)。

驗證端同樣受時間問題限制。Xu 等以全測站追蹤稜鏡,評估兩套商用室內移動掃描系統的軌跡時,其中 Leica BLK ARC 不提供時間資訊,無法與全測站軌跡時間同步,只能改以最近點建立對應(Xu et al., 2025b, Sec. 3.1.1)。NTU VIRAL 資料集的作者則說明,真值與機載資料的時間對齊只能限定在 0.1 s 以內(Nguyen et al., 2022a, Sec. 5.3)。

下方計算把上一節的一階關係套用到時間偏移:輸入平台的角速度、速度、時間偏移與測距,估計點的位移範圍,並可用 Faizullin 等的算例核對。

計算 F-01c時間偏移造成的點位移:一階估算教學模擬 · 非實測資料
角速度換算
1.05 rad/s
Δt 期間的轉角 ωΔt
0.300°(5.24 mrad)
平移項 b = vΔt
0.50 cm
轉動項 a = 2r·sin(ωΔt/2)
10.5 cm
點位移 |δp| 範圍
9.97 至 11.0 cm
上界 11.0 cm轉動項占上界 95%

計算式:點的時間戳記若偏差 Δt,投影時就會改用早或晚 Δt 的位姿;若平台在這段時間以速度 v、角速度 ω 等速運動,位姿誤差約為平移 vΔt 與轉角 ωΔt。轉動項與測距成正比,兩項同向時相加、反向時互相抵銷:

∣ a−b ∣  ≤  ∣δp∣  ≤  a+ba=2r ∣sin⁡ω Δt2∣,b=v Δt\begin{gathered}\bigl|\,a-b\,\bigr|\;\le\;|\delta\mathbf p|\;\le\;a+b\\ a=2r\,\Bigl|\sin\tfrac{\omega\,\Delta t}{2}\Bigr|,\quad b=v\,\Delta t\end{gathered}

核對:Faizullin 等在引言中以算例說明同步的重要性:以 5 rad/s 旋轉時,10 ms 的時間偏移造成約 3° 的旋轉誤差,使 10 m 處物體偏移約 50 cm(Faizullin et al., 2022, Sec. I)。按上方按鈕可用同一組數值重算。

簡化條件:Δt 內速度與角速度固定;轉軸垂直於光束(轉動項取最大值);感測器位於旋轉中心,因此 r 同時是測距與槓桿臂;只看單一點。這是幾何估算,不是任何系統的實測誤差。實際系統中,固定時間偏移在等速運動下可能主要造成整批點的偏移(見互動 F-01b),也可能使依賴 IMU 的去畸變失效(Zhu et al., 2022b, Sec. I),影響大小取決於估計器如何使用時間戳記。

運動畸變與去畸變

旋轉式 LiDAR 一圈的點不是同時量到的。平台在掃描期間移動時,若把整圈點都用同一個位姿投影,點雲就會產生運動畸變(motion distortion):牆線彎折,掃描起點與終點相接處錯開。Hong 等指出,一般 ICP 假設一次掃描中的點是同時量測的,但多數測距儀是逐點依序量測,快速運動時誤差會累積(Hong et al., 2010, abstract)。Zhao 等也指出,移動平台上的雷射點雲可能因運動畸變帶有公分到公寸等級的誤差,而 LiDAR 里程計或 SLAM 常忽略這個問題(Zhao et al., 2024a, abstract)。

去畸變(deskewing / motion compensation)的核心,是為每個點找到它量測時刻的位姿 Twb(tk)\mathbf T_{wb}(t_k),再用同一條方程式投影。各方法的差別在於如何取得掃描期間的運動。

掃描內等速假設

LOAM 假設一次掃描內角速度與線速度固定,以線性內插求出每個點的位姿後重新投影;可選用 IMU 前處理,去除姿態變化與部分加速度造成的畸變(Zhang & Singh, 2014, Sec. V-C, VII-B)。作者說明此假設要求掃描內速度平滑,劇烈運動需要 IMU(Zhang & Singh, 2014, Sec. III, VII-B);在四次手持測試中,加入 IMU 前處理的相對誤差都最低(Zhang & Singh, 2014, Sec. VII-B, Table II)。VICP 同樣假設掃描期間速度固定:以前後兩次掃描的相對轉換估計測距儀的速度,據以校正每個點後重跑 ICP,再更新速度直到收斂(Hong et al., 2010, Sec. IV-B);作者只以 2D 測距儀在模擬與一間辦公室中測試,實測沒有真值,只能以回到起點的漂移評估(Hong et al., 2010, Sec. V, VI)。Zhao 等也採用掃描內等速的假設,但不用 IMU,也不需每個點的實際時間戳記:以點到面 ICP 配準相鄰兩幀取得幀間運動,再依各點的雷射發射順序線性內插,把每個點轉回該幀起始位姿(Zhao et al., 2024a, Sec. 3)。其室內驗證以平均約 0.33 m/s 移動的 UGV 搭載 Velodyne HDL-32E,並以 TLS 點雲為參考(Zhao et al., 2024a, Sec. 4);作者指出室內平台移動緩慢,改善約在 3 cm 左右,戶外情況則只以模擬評估(Zhao et al., 2024a, Sec. 5)。

以 IMU 傳播逐點補償

LIO-SAM 以 IMU 估計的非線性運動對每次掃描去畸變,同時提供掃描匹配的初值(Shan et al., 2020, Sec. I)。FAST-LIO 以 IMU 前向傳播進行濾波預測,再以反向傳播(back-propagation)把掃描內每個特徵點補償到掃描結束時刻(Xu & Zhang, 2021);FAST-LIO2 沿用這種逐點反向傳播(Xu et al., 2022)。Talbot 等的連續時間估計綜述也以 FAST-LIO 為例說明這種作法(Talbot et al., 2025, Sec. IV-A-1)。

DLIO 先以 IMU 做粗略的離散積分,再以恆定急動度(constant jerk)與恆定角加速度的解析連續時間式逐點修正(Chen et al., 2023, Sec. III)。在 Newer College Dynamic 序列(角速度最高 3.5 rad/s)的消融實驗中,作者報告絕對軌跡誤差(absolute trajectory error, ATE)的 RMSE 由不做運動修正的 0.1959 m 降到完整修正的 0.0612 m(Chen et al., 2023, Sec. IV-A, Table I)。

把掃描內運動納入估計:連續時間方法

Bosse 與 Zlot 處理以旋轉 2D 雷射在行進中取得的三維點雲,半圈掃描約需 1 s。他們不依賴里程計或 IMU,每 0.2 s 取樣一個軌跡修正量,匹配約束在相鄰樣本間線性內插,最後以三次樣條重建連續軌跡;方法沒有迴圈閉合,屬開迴路里程計(Bosse & Zlot, 2009, Sec. II-III)。測試場域是平坦鋪面的工業園區與輕度林地,不是營建工地(Bosse & Zlot, 2009, Sec. III)。

CT-ICP 以每次掃描的起始與結束兩個位姿描述掃描內的運動,在點到平面 ICP 中同時估計畸變(Dellenbach et al., 2022)。在作者的消融實驗中,改用等速預先去畸變加單一位姿後,KITTI-raw 的相對平移誤差由 0.55% 升到 0.79%,KITTI-360 由 0.45% 升到 0.60%(Dellenbach et al., 2022, Sec. V-B)。Traj-LO 作者則報告 CT-ICP 在 NTU VIRAL 的無人機序列中有一半失敗,並歸因於快速運動下起訖位姿的線性內插不足(Zheng & Zhu, 2024, Sec. IV-B);Traj-LO 本身以 SE(3) 中的分段線性軌跡表示運動,每個點以自己的時間戳記查詢位姿後配準(Zheng & Zhu, 2024, Sec. III-B)。

Elastic LiDAR Fusion 在局部以滑動視窗的連續時間軌跡處理手持旋轉 LiDAR 的運動畸變,軌跡在子取樣位姿之間線性內插(Park et al., 2018, Sec. IV-A);全域一致性則在迴圈發生時以面元地圖的非剛性變形達成(Park et al., 2018)。其期刊延伸版(正式版稱 ElasticLiDAR++)把這個架構推廣到多線 3D LiDAR,並融合 IMU 與相機:局部以 100 Hz 線性內插的連續時間軌跡處理畸變,再以 B 樣條在 SE(3) 上估計修正量,同時線上估計 LiDAR 與相機的時間延遲(Park et al., 2022, Sec. IV-A to IV-D);實作約需 2.1 s 處理 1 s 的資料,尚非即時(Park et al., 2022, Sec. VIII-B)。

Point-LIO 的作法不屬於上述任一類:它沒有整幀去畸變的步驟,而是在每個 LiDAR 點或 IMU 取樣到達時,以不迭代的流形擴展卡爾曼濾波傳播並更新狀態,讓每個點在自己的取樣時刻融合;狀態仍以離散時間表示,只是更新發生在每個量測時刻(He et al., 2023a, Sec. 4.2 to 4.4)。由於驅動程式以封包輸出掃描,實作上是先把封包內的點與 IMU 取樣依時間戳記排序,再逐一處理(He et al., 2023a, Sec. 5.1)。

Talbot 等指出,離散時間流程中的運動畸變修正是一個「雞生蛋、蛋生雞」的問題,會引入難以建模的誤差(Talbot et al., 2025, Sec. I):去畸變需要軌跡,而軌跡估計又需要去畸變後的點。

下方互動圖以 2D 房間模擬一圈掃描,可調整平台速度與角速度、速度估計誤差與時間偏移,比較未去畸變與以等速模型去畸變的點。請特別比較「點到牆 RMS」與「剛體對齊後 RMS」:在一圈內等速的設定下,時間偏移主要讓整批點一起偏移,速度估計誤差則留下形狀誤差。

互動 F-01b掃描期間的運動畸變與去畸變(deskew)教學模擬 · 非實測資料
圖層
接縫

接縫放大

0.2 m

圈選點:最後一束(k = N−1);線段:它到最初兩束點連線的垂直距離(接縫錯位)。

  • 參考牆面(真值)
  • 未去畸變:全部點以起始位姿投影
  • 去畸變:以估計等速運動逐點投影
  • 真實平台軌跡(目前位姿、起始位姿)
  • 運動估計(含 ε 與 Δt)
  • 目前擷取的雷射束
整圈 360 點的示意指標:未去畸變與去畸變比較
示意指標(整圈 360 點)未去畸變去畸變
點到牆 RMS0.153 m0.000 m
剛體對齊後 RMS0.064 m0.000 m
接縫錯位0.319 m0.000 m
t = 0.100 s(第 360 / 360 束)一圈內真實運動:vT = 0.150 m、ωT = 4.5°運動估計:v̂ = 1.50 m/s、ω̂ = 45.0 °/sΔt 相當於:v̂Δt = 0.000 m、ω̂Δt = 0.00°

模型:雷射逆時針旋轉,一圈 N = 360 束、週期 T = 0.1 s;第 k 束在 tk = kT/N 由當下的真實位姿射出,得到感測器座標中的點 pk\mathbf p_k,其真實世界位置為 pk∗\mathbf p^{\ast}_k。未去畸變點 p~k\tilde{\mathbf p}_k(橙)全部以起始位姿 T0T_0 投影;去畸變點 p^k\hat{\mathbf p}_k(青)以等速模型在各點時間戳記(含偏移 Δt)的估計位姿投影。Exp 為等速平面運動(SE(2) 指數映射)在該段時間造成的位姿變化,ξ\boldsymbol\xi 為真實的機體速度(前進速度、側向速度 0、偏航角速度):

pk∗=T0 Exp⁡(tk ξ) pkp~k=T0 pkp^k=T0 Exp⁡ ⁣((tk+Δt) ξ^) pkξ=(v, 0, ω),ξ^=(1+ε) ξ,tk=kT/N\begin{aligned} \mathbf p^{\ast}_k &= T_0\,\operatorname{Exp}(t_k\,\boldsymbol\xi)\,\mathbf p_k \\ \tilde{\mathbf p}_k &= T_0\,\mathbf p_k \\ \hat{\mathbf p}_k &= T_0\,\operatorname{Exp}\!\big((t_k+\Delta t)\,\hat{\boldsymbol\xi}\big)\,\mathbf p_k \\ \boldsymbol\xi &= (v,\ 0,\ \omega),\quad \hat{\boldsymbol\xi} = (1+\varepsilon)\,\boldsymbol\xi,\quad t_k = kT/N \end{aligned}

觀察重點:(1)先將 ε 與 Δt 歸零,調整 v 與 ω:第 k 點的偏移來自平台在 0 到 tk 之間的運動,平移部分最多 vT,轉動部分約為「距離 × ωtk」,所以越晚擷取、越遠的點偏得越多,牆線彎折,並在方位角 0 的接縫處錯開。按「慢動作播放一圈」(以 2.5 s 播放 0.1 s 的一圈,放慢 25 倍)可看到每一束都從當下位姿射出;也可拖曳「掃描進度」逐步檢視(系統設定減少動態效果時,播放鍵直接顯示整圈)。(2)估計正確且 Δt = 0 時,去畸變點回到牆面。調整 ε:殘餘誤差大致與 |ε| 成正比,低估(ε < 0)時保留同向彎折,高估時朝反向彎折。(3)將 ε 歸零後調整 Δt:本模擬的運動在一圈內等速,固定時間偏移不改變各點之間的相對運動,只讓整批點改用 Δt 之後的估計位姿投影;因此形狀不變(「剛體對齊後 RMS」與「接縫錯位」不受 Δt 影響),整批點依 Δt 內的估計運動(約前進 v̂Δt、轉動 ω̂Δt)一起偏移,「點到牆 RMS」上升。ε ≠ 0 時,這個整體偏移可能部分抵消殘餘畸變,使「點到牆 RMS」反而下降(例如 v = 3 m/s、ω = 90 °/s、ε = −50%、Δt = 50 ms),但形狀誤差不變;因此只看「點到牆 RMS」可能誤判去畸變的效果。若速度在一圈內改變,時間偏移也會取到錯誤的運動區段而造成形狀誤差,本模擬未包含這種情形。

簡化條件:2D 平面;真實運動與運動估計在一圈內皆為等速(無加速度、無振動);測距完美(無雜訊、無遺漏、無多重回波);每束雷射瞬時完成;感測器位於平台旋轉中心、無外參誤差;起始位姿 T0T_0 取真值,只比較一圈之內的畸變;所有點共用同一時間偏移。

指標定義:「點到牆 RMS」=整圈 360 點中,每點到其雷射實際命中之參考牆面所在直線的垂直距離之均方根。「剛體對齊後 RMS」=先以已知的牆面對應、最小化上述距離平方和求出最佳 2D 剛體變換,再計算同一 RMS,剩下的是任何單一剛體變換都無法消除的形狀誤差。「接縫錯位」=最後一束(k = N−1)的點到最初兩束(k = 0、1)點連線的垂直距離,僅在這三點打到同一面牆時定義。三者皆為本模擬的示意指標,並非標準化的點雲品質指標。

量測本身:測距、方向與入射角

即使位姿完美,ps\mathbf p_s 本身也有誤差。VoxelMap 把每個點的不確定性建模為測距雜訊與方向(bearing)雜訊的組合,再與位姿誤差一起傳遞到地圖中的平面,作為點對面殘差的權重;作者指出近距離點以測距雜訊為主,遠距離點以方向雜訊為主(Yuan et al., 2022, Sec. III-A)。這與前面一階式的第 (3) 項一致。

量測誤差也不一定是零均值。Laconte 等以回波波形建模解釋與入射角(incidence angle)及距離相關的測距偏差,在實驗裝置中量得受測 LiDAR 在 10 m 內、高入射角時偏差可達 20 cm(Laconte et al., 2019, abstract; Sec. VI)。作者指出,若把量測當作零均值高斯雜訊,長直隧道或走廊的地圖會依靠近哪一側牆而產生可預期的彎曲與定位漂移;以偏差模型修正後,地下長廊範例的地圖彎曲減少(Laconte et al., 2019, Sec. I, Fig. 1),但這項改善只以圖示呈現,沒有量化的漂移或地圖誤差(Laconte et al., 2019, Sec. V, Figs. 1 and 9)。

入射角的影響在地面雷射掃描(TLS)文獻中也有量化。Soudarissanane 等由簡化的雷達距離方程式推導,指出訊噪比隨入射角餘弦與距離平方下降(Soudarissanane et al., 2011, Sec. 2.2);在以兩站掃描空房間的實驗中,約 20% 的量測雜訊來自非零入射角,去除入射角效應後,平均標準差由 3.23 mm 降為 2.55 mm(Soudarissanane et al., 2011, Sec. 5.2.3)。該文只處理雜訊,不處理偏差(Soudarissanane et al., 2011, Sec. 3.2)。Lichti 對調幅連續波 TLS 做自率定時則發現,入射角大於約 65° 後距離殘差明顯增大,因此事先剔除斜射點(Lichti, 2007, Sec. 4.4, Fig. 12)。這兩篇都是受控條件下的靜態 TLS,但與 Laconte 等的結果方向一致:斜射量測的點品質較差(推論)。

感測器本身的校正也會隨時間改變。Glennie 等以三台 VLP-16 做靜態試驗:以平面約束的幾何校正可使單次資料的平面閉合差 RMSE 降低 10% 至 20%,但以某組資料求得的參數套用到同一台的其他資料時,無法重現同樣的改善,作者認為這可能源於個別雷射與溫度無關的長期測距漂移(Glennie et al., 2016, Sec. 4.2, 4.3)。三台的平面殘差 RMSE 為 22.2 至 26.9 mm,仍在廠商 3 cm 規格內(Glennie et al., 2016, Sec. 4.2)。另兩項試驗在近距離、白色平面靶與接近垂直入射的理想條件下量得測距標準差約 5 至 18 mm,作者指出這些數字代表的是雜訊下限(Glennie et al., 2016, Sec. 4.1, 4.3)。Lichti 的自率定也顯示,多數附加參數在數小時到 13 個月之間有顯著變動,作者無法判斷這反映儀器不穩定,還是顯著性檢定過於嚴格(Lichti, 2007, Sec. 4.3, Table 3, Sec. 5)。Glennie 另一篇以車載動態資料校正多光束 HDL-64E S2 的研究則發現,部分參數彼此高度相關或幾乎不可觀測,無法從動態資料可靠估計;縮減參數後,平面閉合差 RMSE 由只做視準校正的 0.047 m 降至 0.034 m(Glennie, 2012, Observability section; Table 4),加入靜態校正的水平旋轉修正後為 0.030 m,再剔除入射角大於 70° 的回波可降至 0.022 m(Glennie, 2012, Table 4; Comparison section)。

營建相關文獻也提醒材質與入射角的影響。Bosché 與 Guenet 以 TLS 做樓板平整度檢查時說明,掃描儀的誤差數值只是參考,會隨材質與入射角改變(Bosché & Guenet, 2014, Sec. 2.2)。Hawley 與 Gräbe 在實驗室以 12 種顏色光澤的 MDF 靶,以及不同骨材、粗糙度與含水狀態的混凝土靶,在 2 至 6 m、入射角 0° 至 45° 下評估 Hovermap(內含 VLP-16)的回波強度與相對最佳擬合平面的測距標準差(Hawley & Gräbe, 2022, Sec. 4):除黑色外的 MDF 靶在 6 m 內的測距標準差為 9.2 至 13.0 mm,黑色靶可達 26.9 mm(Hawley & Gräbe, 2022, Table 1);同一混凝土靶在含水飽和時,回波強度降低 70% 至 80%(Hawley & Gräbe, 2022, Sec. 7)。

誤差預算

把各誤差來源的典型大小代入地理定位方程式,傳播到點座標並加總,就得到誤差預算(error budget)。Glennie 把 LiDAR 直接地理定位方程式中的 14 個觀測量(GNSS 位置、IMU 姿態、視準角、掃描角、距離與槓桿臂)做一階展開,將典型誤差傳遞為點位的水平與垂直精度,並分析定翼機、直升機與地面車載三種平台;地面系統的誤差以雷射掃描儀本身為主,姿態誤差的貢獻低於 25%(Glennie, 2007, Theoretical accuracy analysis)。模型預測與定翼機控制點、直升機連結點閉合差及地面系統高程檢核的實測結果相近(Glennie, 2007, Tables 6-8);作者也認為只檢查高程誤差不足以描述這類產品的精度(Glennie, 2007, abstract)。這個模型不含 GNSS 定位誤差(須另行相加),也忽略入射角與地形坡度(Glennie, 2007, Positioning errors; Laser scanner errors)。

對點雲品質與工程的意義

本節把前面的幾何關係與文獻證據連到營建工程任務。除非另有引用,以下多屬推論,並以推論框標示。

遠距離牆面:角度誤差的槓桿臂

移動平台:時間誤差會換算成位姿誤差

商用設備:無法逐項檢查,只能檢核成果

Keitaanniemi 等指出,商用 SLAM 演算法對使用者而言是黑箱(Keitaanniemi et al., 2023, Sec. 1);Xu 等也遇到商用系統不提供時間資訊的情況(Xu et al., 2025b, Sec. 3.1.1)。

驗證本身也有座標系與時間問題

以全測站或控制點驗證 SLAM 軌跡時,參考量測同樣要經過座標與時間轉換。NTU VIRAL 的真值是全測站追蹤的稜鏡位置,稜鏡距機體原點約 0.4 m,作者提醒評估時必須換算到稜鏡位置,否則可能產生最壞約 0.4 m 的偏差(Nguyen et al., 2022a, Sec. 2.5, 6.1);真值與機載資料的時間對齊也只限定在 0.1 s 以內(Nguyen et al., 2022a, Sec. 5.3)。Hilti-Oxford 資料集以毫米級控制點評分,但作者也說明,因未另行校正 LiDAR 與 IMU 之間的外參,真值控制點本身可能帶有數毫米誤差(Zhang et al., 2023c, Sec. VI-C)。

各環節的證據落在哪種環境

下表依本站已查證紀錄的驗證環境欄位整理,只描述證據的分布,不評比方法。

點形成各環節的代表證據、驗證環境與營建工地證據
環節本頁引用的代表證據驗證環境施工中工地的量化證據
外參校正LI-Calib(Lv et al., 2020)、Le Gentil 等(Le Gentil et al., 2018)、LI-Init(Zhu et al., 2022b)模擬、受控實驗(手持或自組設備);LI-Calib 另以動作捕捉系統核對估得的軌跡未見。營建機具研究假設外參已知,並指出難以精確取得(Nubert et al., 2022a)
時間同步Faizullin 等(Faizullin et al., 2022)、LI-Init(Zhu et al., 2022b);Olson、Furgale 等、Rehder 等、Li 與 Mourikis(Olson, 2010; Furgale et al., 2013; Rehder et al., 2016; Li & Mourikis, 2014)受控實驗、模擬,Li 與 Mourikis 另有車載實測;Olson 只用合成資料;Furgale 等與 Li 與 Mourikis 只處理相機與 IMU,Rehder 等另含 2D 雷射測距儀未見
去畸變LOAM(Zhang & Singh, 2014)、DLIO(Chen et al., 2023)、CT-ICP(Dellenbach et al., 2022)、Bosse 與 Zlot(Bosse & Zlot, 2009)公開資料集(道路、校園)、模擬、既有建物、工業園區與林地 未見分離去畸變效果的工地研究。Traj-LO 以逐點時間戳記配準取代獨立的去畸變步驟,在含施工現場序列的 Hilti 2021 資料集只報告軌跡誤差,未評估點雲幾何(Zheng & Zhu, 2024)
量測偏差Laconte 等(Laconte et al., 2019)、Soudarissanane 等(Soudarissanane et al., 2011)、Lichti(Lichti, 2007)、Glennie 等 2016(Glennie et al., 2016)、Glennie 2012(Glennie, 2012)、Hawley 與 Gräbe(Hawley & Gräbe, 2022)受控實驗(實驗室、空房間、停車場車載)、大學地下通道;Hawley 與 Gräbe 的量測評估在實驗室完成,現場為營運中鐵路隧道未見
整體結果(含漂移)Keitaanniemi 等(Keitaanniemi et al., 2023)、Trybała 等(Trybała et al., 2023)既有建物、地下坑道,皆以 TLS 為獨立參考未見;工地層級的評估見 C-02

「未見」指本站已查證的文獻紀錄中未見,不代表該研究不存在。

下一步:點在地圖上的位置取決於軌跡 Twb(t)\mathbf T_{wb}(t),而軌跡主要由掃描與地圖的配準估計,見 F-02 點雲配準。

選擇開啟Esc關閉