imu_tk**位址
ii. s ensor e rror m odel
對於理想的imu，加速度計三元組的3個軸和陀螺儀三元組的3個軸定義單個共享的正交3d幀。 每個加速度計檢測沿乙個不同軸的加速度，而每個陀螺儀測量圍繞同一軸的角速度。 不幸的是，在實際imu中，由於組裝不準確，兩個三元組形成兩個不同的（即，未對準的）非正交的幀。 此外，單個感測器並不完美：通常，用於以實際物理量轉換感測器的數字輸出的比例因子對於相同感測器的不同例項是不同的，而製造商僅提供預設的標稱比例因子。 此外，輸出訊號幾乎總是受非零可變偏差的影響。
如上所述，加速度計幀（af）和陀螺儀幀（gf）通常都是非正交的。 我們可以通過以下方式定義兩個相關的正交理想幀（分別為aof和gof）：
•aof的x軸和af的x軸重合
•aof的y軸位於af的x軸和y軸所跨越的平面中。
對於陀螺儀情況，分別用gf和gof替換af和aof縮寫詞就足夠了。 最後，我們定義乙個主體框架（bf），它是乙個正交框架，表示例如imu底盤的座標系。 車身框架通常與af和gf框架的角度不同，但通常它們之間沒有直接關係。 對於小角度，非正交幀（af或gf）中的測量s s可以在正交體幀中變換為（對於推導的細節，參見[18]）：
其中s b和s s分別表示車身座標和加速度計（或陀螺儀）座標中的特定力（加速度）或等效的旋轉速度。 這裡βij是圍繞第j個bf軸的第i個加速度計或陀螺儀軸的旋轉，參見圖2。
另一方面，兩個正交幀bf和aof（以及等效地，bf和gof）通過純旋轉相關。
在所提出的校準方法中，我們假設車身框架bf與加速度計正交框架aof一致：在這種情況下，角度βxz，βxy，βyx變為零，因此在加速度計情況下，等式1變為：
我們改變字母β，參考一般情況，字母α，指加速度計情況，而o和s分別表示aof和af中的特定加速度3。
如前所述，陀螺儀和加速度計測量應參考相同的參考係，在我們的例子中是aof。 然後，使用eq 1，對於陀螺儀，我們有：
其中ωo和ωs分別表示aof和gf中的特定角速度。
加速度計和陀螺儀都受到偏差和尺度誤差的影響。 引入了兩個縮放矩陣
我們還介紹了兩個偏向量
完整的感測器誤差模型是
對於加速度計
對於陀螺儀，其中νg和νg分別是加速度計測量雜訊和陀螺儀測量雜訊。
iii. b asic c alibration f ramework
為了校準加速度計三元組，我們需要估計以下未知引數向量：
我們定義以下函式：
在這裡，我們可以忽略測量雜訊，因為在我們的校準過程中，我們在每個靜態間隔中應用訊號平均。
與傳統的多位置方案一樣，我們將imu移動到一組m個不同的，暫時穩定的旋轉中。 我們可以提取m個加速度向量sk（在非正交af中測量），在每個靜態間隔內的時間視窗中對加速度計讀數求平均。 我們用來估算加速度計引數的成本函式是：
其中|| g || 是可以從特定公共**中容易地恢復的區域性重力向量的實際大小（例如，知道我們正在執行校準的位置的緯度，經度和高度）。 為了最小化eq 10，我們採用levenberg-marquardt（lm）演算法。
為了校準陀螺儀三元組，我們可以假設系統無偏置，在適當的無運動初始階段簡單地平均靜態陀螺儀訊號。 以下關於艾倫方差的討論證明了這一點（參見第iv-c節）。 此外，由於我們需要使用加速度計作為已知參考，我們使用上面計算的校準引數θacc，用等式9校正加速度計讀數。
我們定義運算子ψ，它將n個陀螺儀讀數的序列ωsi和由校準的加速度計給出的初始重力值ua，k-1（即表示重力方向的單位向量）作為輸入，並返回最終的重力 或者ug，k，使用第k-1和第k個靜態區間之間的陀螺儀測量值計算：
ψ可以是通過積分輸入角速度來計算最終方向的任何積分演算法。我們需要估計以校準陀螺儀的未知引數向量是：
在這種情況下，我們可以將成本函式定義為：
其中m是靜態區間的數量，ua，k是在時間視窗中對第k個靜態區間中的校準加速度計讀數進行平均測量的加速度，並且ug，k是使用等式11計算的加速度對數（即，積分 第k-1和第k個靜態區間之間的角速度）。 我們獲得θ陀螺，用lm最小化eq 13。
iv. c alibration p rocedure
如第二節所述。 i，所提出的校準框架需要收集具有原始加速度計和陀螺儀讀數的流的資料集，當操作者在不同的靜態位置移動imu時獲取該資料集，以便產生一組不同的，暫時穩定的旋轉。 我們的校準協議的簡單圖表如圖1所示。 iii，為了減輕eq 10和eq 13最小化時的雜訊影響，我們需要在適當的時間間隔內對訊號求平均值。 這對靜態間隔的長度施加了下限（圖1中的t等待）。沒有運動的初始化週期（圖1中的t init）也是必不可少的：這將被用來表徵陀螺儀的偏差（ 第iv-c節）和靜態探測器操作員（第iv-a節）。
a. static detector
校準的準確性很大程度上取決於靜態和運動間隔之間分類的可靠性：校準加速度計我們使用靜態間隔，而對於陀螺儀校準，我們還包括兩個連續靜態間隔之間的運動間隔。根據我們的經驗， 傳遞基於濾波器的運算元，如[8]中使用的準靜態檢測器，對真實資料集表現不佳：檢測到的靜態間隔通常包括一小部分運動。 而且，它們需要微調，因為它們取決於三個引數。
我們建議使用基於方差的靜態檢測器運算元，它利用上面介紹的靜態區間長度的下限。 我們將探測器基於加速度計訊號：給定時間間隔長度為t秒（參見圖1），對於每個加速度計樣本（tx，a ty，tz），在時間t，我們計算方差幅度，即 方差的大小如下：
其中var t w（a t）是在以t為中心的長度為t w秒的時間間隔內計算一般訊號a t的方差的運算元。 我們在靜態和運動間隔之間進行分類，只需檢查ζ（t）的平方是否低於或大於閾值。
作為閾值，我們考慮在所有初始化時段t init上計算的方差幅度ζinit的平方的整數倍。 在所有實驗中，我們使用t w = 2秒，而使用allan方差估計t init（參見第iv-c節）。 值得注意的是，我們的靜態探測器不需要任何引數調整：分類中使用的整數乘數由我們的校準演算法自動估算（參見第iv-d節）。 圖3報告了我們的靜態濾波器如何處理實際資料的示例：在這種情況下，估計的整數乘數為6。
b. runge-kutta integration
d. complete procedure
為了避免校準引數估計中的不可觀察性，必須收集至少九種不同的高度[15]（例如，圖1）。 根據我們的經驗，需要更多n個不同的高度來獲得更好的校準結果，同時保持減少每個靜態間隔的持續時間，以保持陀螺儀偏差的時間穩定性的假設。當36≤n≤50且1秒≤t等於≤4秒時，我們在校準精度，偏差穩定性和降噪之間取得了良好的平衡。
初始化時段t init的持續時間由allan方差分析給出（參見第iv-c節）。 校準協議總結在圖1中，而在演算法1中，報告校準演算法的偽**。
張正友標定法原理 張正友標定演算法原理詳解
擊上方 新機器視覺 選擇加 星標 或 置頂 重磅乾貨，第一時間送達 張正友標定 是指張正友教授1998年提出的單平面棋盤格的攝像機標定方法 1 文中提出的方法介於傳統標定法和自標定法之間，但克服了傳統標定法需要的高精度標定物的缺點，而僅需使用乙個列印出來的棋盤格就可以。同時也相對於自標定而言，提高了...
張正友標定演算法原理詳解
張正友標定 是指張正友教授1998年提出的單平面棋盤格的攝像機標定方法 1 文中提出的方法介於傳統標定法和自標定法之間，但克服了傳統標定法需要的高精度標定物的缺點，而僅需使用乙個列印出來的棋盤格就可以。同時也相對於自標定而言，提高了精度，便於操作。因此張氏標定法被廣泛應用於計算機視覺方面。根據之前部...
相機標定原理講解
世界座標系的三維點投影到成像 座標系中的二維點的投影公式如下 其中 x,y,z 為世界座標系中的三維點 u,v 為成像面座標系中的二維點 a為相機的內引數矩陣 cx,cy 為主光軸點，一般為影象的中心 fx和fy為焦距 r t 為相機的外引數矩陣 r為旋轉矩陣，t為位移矩陣 上述公式的簡單推理過程如...