OpenMVIS

Camera-IMU Calibration
Generated 2026-11-12 22:54:40 · OpenMVIS v0.1.0

1. Summary

✓ OK
Status
0.246 px
Reproj median
✓ good
0.679 px
Reproj p95
✓ good
4
Cameras
4
IMUs
2398
States
6
Iterations
MetricValueGrade
Reprojection median (px)0.2458✓ good
Reprojection p95 (px)0.6789✓ good
Camera χ²/dof0.133✓ good
IMU χ²/dof0.137✓ good
Trajectory states2398
LM iterations6
IMU modelcalyx
t_ga gyro→accel (ms)-0.815 ± 0.023

Reprojection per camera

CameraMean (px)Median (px)P90 (px)P95 (px)Max (px)TagsCorners
cam00.3240.2530.5560.73622.123,06446,128
cam10.3140.2450.5340.69620.311,70623,412
cam20.2720.2300.4640.5628.86,99813,996
cam30.2890.2430.4880.58911.47,64915,298

Per-corner error norms at the solution; guard-skipped corners left out; Tags = distinct tags seen per frame, summed over frames.

2. 3D Geometry

Calibration process

The solved path of the rig around the board. Press Play or drag the bar to follow it, use the buttons to change the view, and drag to rotate. Click a camera on the right to put it on the frustum.

Solved rig

The solved rig to scale, in its own frame: forward along the cameras, right along the baseline. Tap a sensor for its values. Field-of-view rims are traced through each lens model from the image edges.

3. Cameras

cammodelreproj med/p95 pxfx,fy,cx,cytd mstr mslever |mm|rot |rad|baseline mm
cam0equidistant0.253 / 0.74286.5, 286.3, 414.9, 402.6-5.4110.000 (pin)130.823.13454—
cam1equidistant0.245 / 0.70286.5, 286.1, 414.4, 397.0-7.4700.000 (pin)112.243.1312063.69
cam2equidistant0.230 / 0.56426.9, 426.4, 350.4, 265.9-123.24916.682145.123.08633153.41
cam3equidistant0.243 / 0.59423.6, 423.1, 336.5, 256.9-123.30016.729185.963.09370212.75

Camera 0

cam0 — T_C→Ixyz|·|
lever (mm)64.32-110.63-27.15130.82
lever σ (mm)0.130.150.30
rotation (rad)-0.03181-2.217572.215123.13454
rotation σ (rad)3.58e-043.13e-041.92e-04
cam0 — temporal / distortionvalue
td (ms)-5.411 (σ 0.022)
tr (ms)0.000 [pinned]
intr σ (fx,fy,cx,cy)0.099 0.100 0.091 0.094
distortion-0.00538 0.03571 -0.03149 0.00411
dist σ2.00e-03 5.35e-03 5.50e-03 1.89e-03
corner accountingcorners: 46128 used, 0 past fold, 0 other invalid; 2 no-pose frames, 0 outliers; max theta 73.4 deg

Camera 1

cam1 — T_C→Ixyz|·|
lever (mm)0.66-108.91-27.15112.24
lever σ (mm)0.140.160.32
rotation (rad)-0.03923-2.212412.215433.13120
rotation σ (rad)4.47e-043.89e-041.95e-04
cam1 — temporal / distortionvalue
td (ms)-7.470 (σ 0.026)
tr (ms)0.000 [pinned]
intr σ (fx,fy,cx,cy)0.123 0.124 0.117 0.126
distortion-0.00682 0.04039 -0.03709 0.00611
dist σ2.65e-03 6.97e-03 7.04e-03 2.38e-03
corner accountingcorners: 23412 used, 0 past fold, 0 other invalid; 2 no-pose frames, 0 outliers; max theta 75.4 deg

Camera 2

cam2 — T_C→Ixyz|·|
lever (mm)-89.00-112.43-22.32145.12
lever σ (mm)0.130.150.32
rotation (rad)-0.00383-2.083482.276953.08633
rotation σ (rad)4.32e-044.81e-041.92e-04
cam2 — temporal / distortionvalue
td (ms)-123.249 (σ 0.066)
tr (ms)16.682
intr σ (fx,fy,cx,cy)0.191 0.190 0.185 0.166
distortion-0.09301 -0.00821 -0.02133 0.01729
dist σ4.83e-03 2.26e-02 4.02e-02 2.37e-02
corner accountingcorners: 13996 used, 0 past fold, 0 other invalid; 3 no-pose frames, 0 outliers; max theta 56.6 deg

Camera 3

cam3 — T_C→Ixyz|·|
lever (mm)-148.34-110.18-20.89185.96
lever σ (mm)0.130.150.32
rotation (rad)0.01351-2.112922.259723.09370
rotation σ (rad)4.04e-044.60e-041.93e-04
cam3 — temporal / distortionvalue
td (ms)-123.300 (σ 0.060)
tr (ms)16.729
intr σ (fx,fy,cx,cy)0.185 0.184 0.175 0.151
distortion-0.08925 -0.01837 -0.00383 0.00578
dist σ4.31e-03 1.87e-02 3.11e-02 1.73e-02
corner accountingcorners: 15298 used, 0 past fold, 0 other invalid; 1 no-pose frames, 0 outliers; max theta 58.6 deg

4. Board Shape

Per-corner height off the flat board, estimated with the camera-IMU solve (estimate.board_points). The mean plane and tilt belong to the board pose, so a flat board shows only noise here.

MetricValue
Peak to peak (mm)8.97
RMS (mm)2.21
Corners seen72 of 144
Median height σ (mm)0.43

5. Reprojection Analysis

Per camera

CameraMean (px)Median (px)P90 (px)P95 (px)Max (px)TagsCorners
cam00.3240.2530.5560.73622.123,06446,128
cam10.3140.2450.5340.69620.311,70623,412
cam20.2720.2300.4640.5628.86,99813,996
cam30.2890.2430.4880.58911.47,64915,298

Per-corner error norms at the solution; guard-skipped corners left out; Tags = distinct tags seen per frame, summed over frames.

5.1 Camera 0 — reprojection

0.253 px
Median
✓ good
0.736 px
P95
✓ good
0.324 px
Mean
800
Frames
46,128
Corners

Per frame

Per tag

Error distribution

Scatter by frame and error per board corner

5.2 Camera 1 — reprojection

0.245 px
Median
✓ good
0.696 px
P95
✓ good
0.314 px
Mean
400
Frames
23,412
Corners

Per frame

Per tag

Error distribution

Scatter by frame and error per board corner

5.3 Camera 2 — reprojection

0.230 px
Median
✓ good
0.562 px
P95
✓ good
0.272 px
Mean
354
Frames
13,996
Corners

Per frame

Per tag

Error distribution

Scatter by frame and error per board corner

5.4 Camera 3 — reprojection

0.243 px
Median
✓ good
0.589 px
P95
✓ good
0.289 px
Mean
354
Frames
15,298
Corners

Per frame

Per tag

Error distribution

Scatter by frame and error per board corner

6. Motion & Excitation

Body-frame angular velocity finite-differenced from the solved trajectory states — the excitation context for lever-arm / td observability.

7. Base IMU (imu0, model calyx)

paramvalue
b_g-0.01035 0.00249 -0.00188
b_g drift0.00085 -0.00013 -0.00034
b_a0.0006 -0.0357 0.0067
b_a drift0.0105 0.0028 -0.0076
R_wtoI (rad)-0.00115 0.00109 -0.00028
t_ga gyro→accel (ms)-0.815 ± 0.023 (gyro clock is reference: accel stamped t sampled at t − t_ga)

IMU intrinsics (full)

Dw (gyro)
+0.998130-0.000451+0.003038
-0.000282+0.997679+0.002154
-0.001083-0.001151+1.000896
Da (accel)
+0.999943-0.000770+0.000160
+0.000000+0.996422-0.000937
+0.000000+0.000000+1.001242
Tg (g-sensitivity)
+0.000000-0.000000+0.000000
-0.000000+0.000000-0.000000
+0.000000+0.000000-0.000000

Bias evolution

8. Aux IMUs

Per-IMU parameters in the base-IMU format; the spatial (T_IstoI) and temporal (td) rows are relative to the base IMU.

gx3_25

paramvalue
td vs base (ms)-0.691
t_ga gyro→accel (ms)+0.098 ± 0.019
χ²/dof0.28
T_IstoI lever p_IsinI (mm)[-122.81, -45.26, -3.06] |130.92|
T_IstoI rotation (rad)[2.25021, 2.18493, -0.02792] |3.13658|
b_g-0.00082 -0.00460 -0.01203
b_a-0.0926 -0.0118 0.0003

IMU intrinsics (full)

Dw (gyro)
+0.999935-0.000259-0.002138
-0.000407+0.999781-0.001152
+0.000693+0.003838+1.002722
Da (accel)
+0.995418+0.001168+0.002355
+0.000000+1.001142-0.002074
+0.000000+0.000000+1.000833
Tg (g-sensitivity)
+0.000000-0.000000+0.000000
+0.000000-0.000000+0.000000
+0.000000-0.000000+0.000000

gx3_35

paramvalue
td vs base (ms)-2.071
t_ga gyro→accel (ms)+0.009 ± 0.021
χ²/dof0.31
T_IstoI lever p_IsinI (mm)[-82.29, -46.18, -3.45] |94.42|
T_IstoI rotation (rad)[2.23039, 2.20704, -0.01922] |3.13784|
b_g0.00249 -0.00023 -0.00118
b_a-0.0372 0.0644 -0.0103

IMU intrinsics (full)

Dw (gyro)
+0.999016+0.000472-0.002434
-0.001584+0.998589-0.003107
+0.001321+0.002247+1.000860
Da (accel)
+0.994870+0.002013-0.000441
+0.000000+1.000410-0.002310
+0.000000+0.000000+1.000604
Tg (g-sensitivity)
+0.000000-0.000000-0.000000
+0.000000-0.000000+0.000000
+0.000000+0.000000+0.000000

t265

paramvalue
td vs base (ms)-7.171
t_ga gyro→accel (ms)-6.740 ± 0.018
χ²/dof0.67
T_IstoI lever p_IsinI (mm)[54.73, -107.43, -30.34] |124.33|
T_IstoI rotation (rad)[1.57242, -0.00537, -0.01134] |1.57247|
b_g-0.00054 -0.00238 0.00026
b_a-0.1218 -0.0711 -0.1609

IMU intrinsics (full)

Dw (gyro)
+0.996664+0.001718-0.019285
-0.000715+1.003669-0.001728
+0.020955+0.000497+1.002780
Da (accel)
+1.020538-0.008993-0.021823
+0.000000+1.020345-0.000604
+0.000000+0.000000+1.012303
Tg (g-sensitivity)
+0.000000-0.000000+0.000000
+0.000000-0.000000+0.000000
+0.000000-0.000000+0.000000

9. IMU Residuals

Per-interval cost

Cost split

residual rowscostshare
theta1307.826.6%
p2400.348.8%
v834.216.9%
bg108.22.2%
ba271.15.5%

10. Timing

stagesshare
init_s92.2314.4%
aux_init_s0.430.1%
graph_build_s27.434.3%
pre_diag_s31.384.9%
solve_s398.0262.4%
post_diag_s5.620.9%
marginals_s16.902.6%
per_iteration_s66.3410.4%
total638.35

11. Result files

Files this run wrote, verbatim. Expand one to read or copy it.

cam_imu_calib.yaml · YAML, 12.9 kB (click to expand)

cam_imu_calib.yaml

cameras:
- id: 0
  model: pinhole_equidistant
  intrinsics:
    fx: 286.5371465582649
    fy: 286.33550814558066
    cx: 414.94351334879184
    cy: 402.6390642386356
  distortion:
    model: equidistant
    coeffs:
    - -0.005378562488089815
    - 0.03570702351648733
    - -0.03148814631339278
    - 0.004105604657683594
  image_size:
  - 848
  - 800
  rolling_shutter_readout: 2.269563016437697e-12
  td: -0.005411318613921738
  T_cam_imu:
  - - -0.999769297794261
    - 0.019327049649243304
    - -0.009371037286647094
    - 0.06619292515113587
  - - 0.009391875882854936
    - 0.0009877217503843861
    - -0.9999554075423288
    - -0.027642387883910723
  - - -0.019316931831248302
    - -0.9998127272432575
    - -0.0011690111322858097
    - -0.1093953691411639
  - - 0.0
    - 0.0
    - 0.0
    - 1.0
  reproj_rms_px: 0.5473
  p_CtoC0_m: null
  corner_accounting:
    camera: 0
    model: equidistant
    n_corners: 46128
    used: 46128
    past_fold: 0
    past_fold_pass1: 0
    other_invalid: 0
    no_pose_frames: 2
    no_pose_corners: 8
    discarded_pose_corners: 0
    outliers: 0
    filter_removed: 0
    removed_invalid: 0
    max_theta_deg: 73.3629294880935
    max_theta_used_deg: 73.3629294880935
    fold_deg: null
    fold_level: none
    detected: 276440
    not_in_solve: 230304
  rostopic: /t265/fisheye1/image_raw
- id: 1
  model: pinhole_equidistant
  intrinsics:
    fx: 286.51036694809784
    fy: 286.08254991307524
    cx: 414.4110676652239
    cy: 397.0007414014156
  distortion:
    model: equidistant
    coeffs:
    - -0.00681604909318341
    - 0.040388874464523127
    - -0.03709259555114284
    - 0.006106217052673278
  image_size:
  - 848
  - 800
  rolling_shutter_readout: 6.777248911639162e-13
  td: -0.007469757271456544
  T_cam_imu:
  - - -0.9996325367004744
    - 0.025027640596279706
    - -0.01041195351303592
    - 0.0030983085422192653
  - - 0.010379194458780128
    - -0.0014384660654084998
    - -0.9999451000618809
    - -0.027310624783431135
  - - -0.0250412438221632
    - -0.9996857246262755
    - 0.0011781707333287897
    - -0.10882243873783354
  - - 0.0
    - 0.0
    - 0.0
    - 1.0
  reproj_rms_px: 0.5596
  p_CtoC0_m:
  - 0.06368709071623473
  - -0.0005963546829420123
  - -0.0004916235829386245
  corner_accounting:
    camera: 1
    model: equidistant
    n_corners: 23412
    used: 23412
    past_fold: 0
    past_fold_pass1: 0
    other_invalid: 0
    no_pose_frames: 2
    no_pose_corners: 8
    discarded_pose_corners: 0
    outliers: 0
    filter_removed: 0
    removed_invalid: 0
    max_theta_deg: 75.41400260940593
    max_theta_used_deg: 75.41400260940593
    fold_deg: null
    fold_level: none
    detected: 281472
    not_in_solve: 258052
  rostopic: /t265/fisheye2/image_raw
- id: 2
  model: pinhole_equidistant
  intrinsics:
    fx: 426.8884511830021
    fy: 426.43960728809196
    cx: 350.4046342943308
    cy: 265.92535806308393
  distortion:
    model: equidistant
    coeffs:
    - -0.09300536229317752
    - -0.00820638099882038
    - -0.021333768894802582
    - 0.017285533080334696
  image_size:
  - 640
  - 480
  rolling_shutter_readout: 0.01668244078537985
  td: -0.12324943171001543
  T_cam_imu:
  - - -0.9984700924763371
    - 0.0424278610030362
    - 0.03545914608391626
    - -0.08330267575784216
  - - -0.03907752445048912
    - -0.08773779976251746
    - -0.995376825918533
    - -0.03556196837053655
  - - -0.03912060215685447
    - -0.995239647071769
    - 0.08926154481827929
    - -0.1133832177476002
  - - 0.0
    - 0.0
    - 0.0
    - 1.0
  reproj_rms_px: 0.3893
  p_CtoC0_m:
  - 0.1532091799377761
  - -0.006267357727685219
  - 0.004758136886158351
  corner_accounting:
    camera: 2
    model: equidistant
    n_corners: 13996
    used: 13996
    past_fold: 0
    past_fold_pass1: 0
    other_invalid: 0
    no_pose_frames: 3
    no_pose_corners: 152
    discarded_pose_corners: 0
    outliers: 0
    filter_removed: 0
    removed_invalid: 0
    max_theta_deg: 56.61827287935246
    max_theta_used_deg: 56.61827287935246
    fold_deg: null
    fold_level: none
    detected: 147032
    not_in_solve: 132884
  rostopic: /elp/split_sync_image_node/left/image_raw
- id: 3
  model: pinhole_equidistant
  intrinsics:
    fx: 423.570525527173
    fy: 423.09573560146765
    cx: 336.5070818675879
    cy: 256.9197532345035
  distortion:
    model: equidistant
    coeffs:
    - -0.08925148280204159
    - -0.01836913733401655
    - -0.0038275696267412633
    - 0.005778650985869448
  image_size:
  - 640
  - 480
  rolling_shutter_readout: 0.016728802662817482
  td: -0.12330018336099896
  T_cam_imu:
  - - -0.9988151016270681
    - 0.029011030104892786
    - 0.03907368544126
    - -0.14414786445712155
  - - -0.040931430183014005
    - -0.06647433411769121
    - -0.9969482338249978
    - -0.03421739886513677
  - - -0.02632509800328489
    - -0.9973662933124733
    - 0.06758303174062874
    - -0.11238670335303157
  - - 0.0
    - 0.0
    - 0.0
    - 1.0
  reproj_rms_px: 0.4425
  p_CtoC0_m:
  - 0.21256112089855456
  - -0.008260152228766558
  - 0.0036572226816713876
  corner_accounting:
    camera: 3
    model: equidistant
    n_corners: 15298
    used: 15298
    past_fold: 0
    past_fold_pass1: 0
    other_invalid: 0
    no_pose_frames: 1
    no_pose_corners: 112
    discarded_pose_corners: 0
    outliers: 0
    filter_removed: 0
    removed_invalid: 0
    max_theta_deg: 58.58790354630043
    max_theta_used_deg: 58.58790354630043
    fold_deg: null
    fold_level: none
    detected: 160852
    not_in_solve: 145442
  rostopic: /elp/split_sync_image_node/right/image_raw
imus:
- name: imu0
  role: base
  model: calyx
  b_g:
  - -0.01034717444412946
  - 0.002485815452503113
  - -0.0018814568440293097
  b_a:
  - 0.0005891057951033314
  - -0.03567374303141616
  - 0.006717348321839029
  topic: /imu/data
  t_ga: -0.0008154998406140277
  t_ga_sigma: 2.25800558587148e-05
  imu_intr_xi:
  - -0.001869618281902491
  - -0.00045073571520433696
  - 0.0030384805365406852
  - -0.00028195381690938946
  - -0.002321491181789441
  - 0.002153591892144231
  - -0.0010834863015744736
  - -0.0011514346057618352
  - 0.0008963301069158104
  - -5.680901772158235e-05
  - -0.0007695590406306156
  - -0.003577972446575987
  - 0.00015972463090076534
  - -0.0009368856262002383
  - 0.00124223053682466
  - 8.08041652536508e-13
  - -9.222357794723357e-12
  - 1.318500798848063e-11
  - -1.5002162060653857e-12
  - 2.8182448320233538e-12
  - 2.0422938369956644e-13
  - 1.0748252154412966e-12
  - -4.877492782855021e-12
  - -2.8519107979486524e-12
  Dw:
  - - 0.9981303817180975
    - -0.00045073571520433696
    - 0.0030384805365406852
  - - -0.00028195381690938946
    - 0.9976785088182105
    - 0.002153591892144231
  - - -0.0010834863015744736
    - -0.0011514346057618352
    - 1.0008963301069158
  Dw_decomposed:
    Dw_scale:
    - 0.99813
    - 0.99768
    - 1.0009
    Dw_shear:
    - -0.00073
    - 0.00195
    - 0.001
    gyro_misalign_rotvec:
    - -0.001155
    - 0.001086
    - -0.000282
  Da:
  - - 0.9999431909822785
    - -0.0007695590406306156
    - 0.00015972463090076534
  - - 0.0
    - 0.996422027553424
    - -0.0009368856262002383
  - - 0.0
    - 0.0
    - 1.0012422305368247
  Dw_diag:
  - 0.99813
  - 0.997679
  - 1.000896
  Da_diag:
  - 0.999943
  - 0.996422
  - 1.001242
  R_wtoI:
  - - 0.9999993709302895
    - 0.0002812280788085744
    - 0.0010858405927720602
  - - -0.0002824817726271915
    - 0.9999992935477452
    - 0.001154602987257752
  - - -0.001085515118897632
    - -0.0011549089911074219
    - 0.9999987439202856
  U_w:
  - - 0.9981310096120828
    - -0.0007313115256701959
    - 0.0019513821758891923
  - - 0.0
    - 0.9976790070486183
    - 0.0009985007059712721
  - - 0.0
    - 0.0
    - 1.0009008587504784
- name: gx3_25
  role: aux
  model: calyx
  td: -0.0006905927469270914
  b_g:
  - -0.0008205106023648477
  - -0.0045993295909870545
  - -0.012032455161249907
  b_a:
  - -0.09257164843743731
  - -0.011782202518256726
  - 0.000270507773629712
  imu_intr_xi:
  - -6.506519844052297e-05
  - -0.00025901844095276087
  - -0.0021382547087661825
  - -0.0004072369118998065
  - -0.00021894731594004427
  - -0.001152259878068376
  - 0.0006931606838110007
  - 0.0038378522892740744
  - 0.0027215688740844465
  - -0.004581963913560191
  - 0.00116761516357395
  - 0.0011423072065538111
  - 0.0023553441210412565
  - -0.002074398301423792
  - 0.000832631550544365
  - 7.78038494897267e-12
  - 2.679853212488401e-12
  - 2.0410783440978404e-12
  - -1.3114509314094832e-11
  - -6.681770958592536e-13
  - -7.317739928430181e-12
  - 1.036122220009559e-12
  - 3.203834014155593e-12
  - 5.280967778444417e-13
  Dw:
  - - 0.9999349348015595
    - -0.00025901844095276087
    - -0.0021382547087661825
  - - -0.0004072369118998065
    - 0.9997810526840599
    - -0.001152259878068376
  - - 0.0006931606838110007
    - 0.0038378522892740744
    - 1.0027215688740845
  Da:
  - - 0.9954180360864399
    - 0.00116761516357395
    - 0.0023553441210412565
  - - 0.0
    - 1.0011423072065537
    - -0.002074398301423792
  - - 0.0
    - 0.0
    - 1.0008326315505445
  Dw_diag:
  - 0.999935
  - 0.999781
  - 1.002722
  Da_diag:
  - 0.995418
  - 1.001142
  - 1.000833
  Dw_decomposed:
    Dw_scale:
    - 0.99994
    - 0.99979
    - 1.00272
    Dw_shear:
    - -0.00066
    - -0.00144
    - 0.0027
    gyro_misalign_rotvec:
    - 0.003839
    - -0.000694
    - -0.000406
  p_IsinI_m:
  - -0.12281309441753445
  - -0.045255816634005915
  - -0.0030563066303746543
  t_ga: 9.795990805466067e-05
  t_ga_sigma: 1.9326644166994554e-05
  topic: /gx3_25/data
- name: gx3_35
  role: aux
  model: calyx
  td: -0.002071351735310647
  b_g:
  - 0.0024912499395028905
  - -0.00023287869976593444
  - -0.0011802146862085283
  b_a:
  - -0.03719295941291045
  - 0.06439141317695696
  - -0.010301222735018434
  imu_intr_xi:
  - -0.0009841127388469473
  - 0.0004717623942091013
  - -0.0024342860415749873
  - -0.0015842329882562673
  - -0.0014105239613900055
  - -0.003106855906228777
  - 0.0013207602385102962
  - 0.002246976864161395
  - 0.0008596860044125668
  - -0.005130018117440385
  - 0.00201332753783707
  - 0.00040972459200812523
  - -0.00044064484675791695
  - -0.002309969335440878
  - 0.000603796074297172
  - 6.760448768614667e-14
  - 2.437670023626588e-13
  - 1.771021894313711e-12
  - -1.1770287389331108e-11
  - -2.5357516198972497e-12
  - 4.67172159413495e-12
  - -2.1639628885074144e-12
  - 2.2489322831587464e-12
  - 6.198045271413694e-13
  Dw:
  - - 0.9990158872611531
    - 0.0004717623942091013
    - -0.0024342860415749873
  - - -0.0015842329882562673
    - 0.99858947603861
    - -0.003106855906228777
  - - 0.0013207602385102962
    - 0.002246976864161395
    - 1.0008596860044126
  Da:
  - - 0.9948699818825596
    - 0.00201332753783707
    - -0.00044064484675791695
  - - 0.0
    - 1.000409724592008
    - -0.002309969335440878
  - - 0.0
    - 0.0
    - 1.0006037960742973
  Dw_diag:
  - 0.999016
  - 0.998589
  - 1.00086
  Da_diag:
  - 0.99487
  - 1.00041
  - 1.000604
  Dw_decomposed:
    Dw_scale:
    - 0.99902
    - 0.99859
    - 1.00087
    Dw_shear:
    - -0.00111
    - -0.00111
    - -0.00086
    gyro_misalign_rotvec:
    - 0.002251
    - -0.001324
    - -0.001584
  p_IsinI_m:
  - -0.0822909843109398
  - -0.046175938352005265
  - -0.003449219829061263
  t_ga: 9.338072167846708e-06
  t_ga_sigma: 2.1291120070169448e-05
  topic: /gx3_35/imu/data
- name: t265
  role: aux
  model: calyx
  td: -0.0071712752050568755
  b_g:
  - -0.0005412782185388042
  - -0.0023793358536210413
  - 0.0002602901862920298
  b_a:
  - -0.1218488682927451
  - -0.07106069218668545
  - -0.16089063395342365
  imu_intr_xi:
  - -0.0033357125366178246
  - 0.0017180394353666162
  - -0.019284675499818136
  - -0.0007146297949285435
  - 0.0036694172702725143
  - -0.001727706130558448
  - 0.02095482021627824
  - 0.0004973572404642927
  - 0.002780032689743814
  - 0.020537892233544793
  - -0.008992811075124764
  - 0.020345455898521218
  - -0.021822970301151278
  - -0.0006044183497736777
  - 0.012302564863909946
  - 2.820747167552702e-12
  - 6.3458775594821e-12
  - 6.99685148558284e-12
  - -5.618680551074827e-13
  - -3.1872200992054947e-13
  - -7.979898207360843e-13
  - 2.1758792524834884e-12
  - 2.603750550936439e-12
  - 7.176463306796561e-14
  Dw:
  - - 0.9966642874633822
    - 0.0017180394353666162
    - -0.019284675499818136
  - - -0.0007146297949285435
    - 1.0036694172702725
    - -0.001727706130558448
  - - 0.02095482021627824
    - 0.0004973572404642927
    - 1.0027800326897438
  Da:
  - - 1.0205378922335449
    - -0.008992811075124764
    - -0.021822970301151278
  - - 0.0
    - 1.0203454558985212
    - -0.0006044183497736777
  - - 0.0
    - 0.0
    - 1.01230256486391
  Dw_diag:
  - 0.996664
  - 1.003669
  - 1.00278
  Da_diag:
  - 1.020538
  - 1.020345
  - 1.012303
  Dw_decomposed:
    Dw_scale:
    - 0.99688
    - 1.00367
    - 1.00296
    Dw_shear:
    - 0.00101
    - 0.0018
    - -0.00127
    gyro_misalign_rotvec:
    - 0.000467
    - -0.021022
    - -0.000712
  p_IsinI_m:
  - 0.05473252640802809
  - -0.10743263090655027
  - -0.030343468693960738
  t_ga: -0.006740097203665449
  t_ga_sigma: 1.8416276909607994e-05
  topic: /t265/imu
diagnostics:
  reproj_rms_px: 0.5155
  ok: true
cam_imu_camchain-imucam.yaml · YAML, 4.1 kB (click to expand)

cam_imu_camchain-imucam.yaml

cam0:
  camera_model: pinhole
  distortion_model: equidistant
  distortion_coeffs:
  - -0.005378562488089815
  - 0.03570702351648733
  - -0.03148814631339278
  - 0.004105604657683594
  intrinsics:
  - 286.5371465582649
  - 286.33550814558066
  - 414.94351334879184
  - 402.6390642386356
  resolution:
  - 848
  - 800
  rostopic: /cam0/image_raw
  T_cam_imu:
  - - -0.999769297794261
    - 0.019327049649243304
    - -0.009371037286647094
    - 0.06619292515113587
  - - 0.009391875882854936
    - 0.0009877217503843861
    - -0.9999554075423288
    - -0.027642387883910723
  - - -0.019316931831248302
    - -0.9998127272432575
    - -0.0011690111322858097
    - -0.1093953691411639
  - - 0.0
    - 0.0
    - 0.0
    - 1.0
  line_delay: 2.8369537705471214e-15
cam1:
  camera_model: pinhole
  distortion_model: equidistant
  distortion_coeffs:
  - -0.00681604909318341
  - 0.040388874464523127
  - -0.03709259555114284
  - 0.006106217052673278
  intrinsics:
  - 286.51036694809784
  - 286.08254991307524
  - 414.4110676652239
  - 397.0007414014156
  resolution:
  - 848
  - 800
  rostopic: /cam1/image_raw
  T_cam_imu:
  - - -0.9996325367004744
    - 0.025027640596279706
    - -0.01041195351303592
    - 0.0030983085422192653
  - - 0.010379194458780128
    - -0.0014384660654084998
    - -0.9999451000618809
    - -0.027310624783431135
  - - -0.0250412438221632
    - -0.9996857246262755
    - 0.0011781707333287897
    - -0.10882243873783354
  - - 0.0
    - 0.0
    - 0.0
    - 1.0
  line_delay: 8.471561139548952e-16
  T_cn_cnm1:
  - - 0.9999832005263329
    - 0.0010477848502634633
    - -0.005700948343724484
    - -0.06368819867588003
  - - -0.001034078443509263
    - 0.9999965693542343
    - 0.0024066494417261737
    - 0.0006633932503212404
  - - 0.005703450436614657
    - -0.002400713783492684
    - 0.9999808534299278
    - 0.0001269463277738291
  - - 0.0
    - 0.0
    - 0.0
    - 1.0
cam2:
  camera_model: pinhole
  distortion_model: equidistant
  distortion_coeffs:
  - -0.09300536229317752
  - -0.00820638099882038
  - -0.021333768894802582
  - 0.017285533080334696
  intrinsics:
  - 426.8884511830021
  - 426.43960728809196
  - 350.4046342943308
  - 265.92535806308393
  resolution:
  - 640
  - 480
  rostopic: /cam2/image_raw
  T_cam_imu:
  - - -0.9984700924763371
    - 0.0424278610030362
    - 0.03545914608391626
    - -0.08330267575784216
  - - -0.03907752445048912
    - -0.08773779976251746
    - -0.995376825918533
    - -0.03556196837053655
  - - -0.03912060215685447
    - -0.995239647071769
    - 0.08926154481827929
    - -0.1133832177476002
  - - 0.0
    - 0.0
    - 0.0
    - 1.0
  line_delay: 3.4755084969541354e-05
  T_cn_cnm1:
  - - 0.9987958616374932
    - -0.04588154566835873
    - -0.017369817008180955
    - -0.08954053303337936
  - - 0.04723111201467018
    - 0.9950427944147582
    - 0.08751605190550736
    - 0.0009906456704323306
  - - 0.013268339522075711
    - -0.08823106624286134
    - 0.9960116616365362
    - -0.007445554671073489
  - - 0.0
    - 0.0
    - 0.0
    - 1.0
cam3:
  camera_model: pinhole
  distortion_model: equidistant
  distortion_coeffs:
  - -0.08925148280204159
  - -0.01836913733401655
  - -0.0038275696267412633
  - 0.005778650985869448
  intrinsics:
  - 423.570525527173
  - 423.09573560146765
  - 336.5070818675879
  - 256.9197532345035
  resolution:
  - 640
  - 480
  rostopic: /cam3/image_raw
  T_cam_imu:
  - - -0.9988151016270681
    - 0.029011030104892786
    - 0.03907368544126
    - -0.14414786445712155
  - - -0.040931430183014005
    - -0.06647433411769121
    - -0.9969482338249978
    - -0.03421739886513677
  - - -0.02632509800328489
    - -0.9973662933124733
    - 0.06758303174062874
    - -0.11238670335303157
  - - 0.0
    - 0.0
    - 0.0
    - 1.0
  line_delay: 3.4851672214203086e-05
  T_cn_cnm1:
  - - 0.9999034023612844
    - -0.0024071833863580794
    - 0.013689098380458913
    - -0.05938672569806397
  - - 0.002697512010505454
    - 0.9997709793697487
    - -0.021229984432552737
    - -0.0008459888983395961
  - - -0.013634858828701822
    - 0.021264860173479498
    - 0.9996808972599819
    - 0.0005807335599952827
  - - 0.0
    - 0.0
    - 0.0
    - 1.0
cam_imu.json · JSON, 7.9 kB (click to expand)

cam_imu.json

{
  "input": "4imus_4cams_01.bag",
  "ok": true,
  "reproj_rms_px": 0.516,
  "reproj_median_px": 0.246,
  "reproj_p95_px": 0.679,
  "solve_s": 582.8,
  "cams": [
    {
      "name": "cam0",
      "td_ms": -5.411,
      "reproj": 0.547,
      "reproj_median": 0.253,
      "reproj_p95": 0.736,
      "intr": [
        286.53715,
        286.33551,
        414.94351,
        402.63906,
        -0.00538,
        0.03571,
        -0.03149,
        0.00411
      ],
      "p_CinI_mm": [
        64.32,
        -110.63,
        -27.15
      ],
      "rotvec": [
        -0.03181,
        -2.21757,
        2.21512
      ],
      "corner_accounting": {
        "camera": 0,
        "model": "equidistant",
        "n_corners": 46128,
        "used": 46128,
        "past_fold": 0,
        "past_fold_pass1": 0,
        "other_invalid": 0,
        "no_pose_frames": 2,
        "no_pose_corners": 8,
        "discarded_pose_corners": 0,
        "outliers": 0,
        "filter_removed": 0,
        "removed_invalid": 0,
        "max_theta_deg": 73.3629294880935,
        "max_theta_used_deg": 73.3629294880935,
        "fold_deg": null,
        "fold_level": "none",
        "detected": 276440,
        "not_in_solve": 230304
      }
    },
    {
      "name": "cam1",
      "td_ms": -7.47,
      "reproj": 0.56,
      "reproj_median": 0.245,
      "reproj_p95": 0.696,
      "intr": [
        286.51037,
        286.08255,
        414.41107,
        397.00074,
        -0.00682,
        0.04039,
        -0.03709,
        0.00611
      ],
      "p_CinI_mm": [
        0.66,
        -108.91,
        -27.15
      ],
      "rotvec": [
        -0.03923,
        -2.21241,
        2.21543
      ],
      "corner_accounting": {
        "camera": 1,
        "model": "equidistant",
        "n_corners": 23412,
        "used": 23412,
        "past_fold": 0,
        "past_fold_pass1": 0,
        "other_invalid": 0,
        "no_pose_frames": 2,
        "no_pose_corners": 8,
        "discarded_pose_corners": 0,
        "outliers": 0,
        "filter_removed": 0,
        "removed_invalid": 0,
        "max_theta_deg": 75.41400260940593,
        "max_theta_used_deg": 75.41400260940593,
        "fold_deg": null,
        "fold_level": "none",
        "detected": 281472,
        "not_in_solve": 258052
      },
      "p_CtoC0_mm": [
        63.69,
        -0.6,
        -0.49
      ]
    },
    {
      "name": "cam2",
      "td_ms": -123.249,
      "reproj": 0.389,
      "reproj_median": 0.23,
      "reproj_p95": 0.562,
      "intr": [
        426.88845,
        426.43961,
        350.40463,
        265.92536,
        -0.09301,
        -0.00821,
        -0.02133,
        0.01729
      ],
      "p_CinI_mm": [
        -89.0,
        -112.43,
        -22.32
      ],
      "rotvec": [
        -0.00383,
        -2.08348,
        2.27695
      ],
      "corner_accounting": {
        "camera": 2,
        "model": "equidistant",
        "n_corners": 13996,
        "used": 13996,
        "past_fold": 0,
        "past_fold_pass1": 0,
        "other_invalid": 0,
        "no_pose_frames": 3,
        "no_pose_corners": 152,
        "discarded_pose_corners": 0,
        "outliers": 0,
        "filter_removed": 0,
        "removed_invalid": 0,
        "max_theta_deg": 56.61827287935246,
        "max_theta_used_deg": 56.61827287935246,
        "fold_deg": null,
        "fold_level": "none",
        "detected": 147032,
        "not_in_solve": 132884
      },
      "p_CtoC0_mm": [
        153.21,
        -6.27,
        4.76
      ]
    },
    {
      "name": "cam3",
      "td_ms": -123.3,
      "reproj": 0.442,
      "reproj_median": 0.243,
      "reproj_p95": 0.589,
      "intr": [
        423.57053,
        423.09574,
        336.50708,
        256.91975,
        -0.08925,
        -0.01837,
        -0.00383,
        0.00578
      ],
      "p_CinI_mm": [
        -148.34,
        -110.18,
        -20.89
      ],
      "rotvec": [
        0.01351,
        -2.11292,
        2.25972
      ],
      "corner_accounting": {
        "camera": 3,
        "model": "equidistant",
        "n_corners": 15298,
        "used": 15298,
        "past_fold": 0,
        "past_fold_pass1": 0,
        "other_invalid": 0,
        "no_pose_frames": 1,
        "no_pose_corners": 112,
        "discarded_pose_corners": 0,
        "outliers": 0,
        "filter_removed": 0,
        "removed_invalid": 0,
        "max_theta_deg": 58.58790354630043,
        "max_theta_used_deg": 58.58790354630043,
        "fold_deg": null,
        "fold_level": "none",
        "detected": 160852,
        "not_in_solve": 145442
      },
      "p_CtoC0_mm": [
        212.56,
        -8.26,
        3.66
      ]
    }
  ],
  "diagnostics": {
    "iterations": 6,
    "cam_chi2_dof": 0.1329,
    "imu_chi2_dof": 0.1369,
    "n_states": 2398,
    "max_iterations": 40
  },
  "board": {
    "T_BinW": [
      [
        0.999986,
        -0.004788,
        0.002146,
        -0.003667
      ],
      [
        -0.000279,
        0.359844,
        0.933012,
        -0.002586
      ],
      [
        -0.005239,
        -0.933,
        0.359838,
        -0.006144
      ],
      [
        0.0,
        0.0,
        0.0,
        1.0
      ]
    ],
    "g_inB": [
      0.005239,
      0.933,
      -0.359838
    ],
    "normal_tilt_deg": 68.9098,
    "g_inplane_deg": 89.6783,
    "shape": {
      "rms_mm": 2.2137,
      "p2p_mm": 8.9694,
      "offset_rms_mm": 0.7163,
      "n_seen": 72,
      "file": "cam_imu_board_shape.yaml"
    }
  },
  "imu_model": "calyx",
  "Dw_diag": [
    0.99813,
    0.99768,
    1.0009
  ],
  "Da_diag": [
    0.99994,
    0.99642,
    1.00124
  ],
  "Dw_scale": [
    0.99813,
    0.99768,
    1.0009
  ],
  "Dw_shear": [
    -0.00073,
    0.00195,
    0.001
  ],
  "gyro_misalign_rotvec": [
    -0.001155,
    0.001086,
    -0.000282
  ],
  "t_ga_ms": -0.8155,
  "t_ga_sigma_ms": 0.0226,
  "imus": [
    {
      "name": "gx3_25",
      "td_ms": -0.691,
      "t_ga_ms": 0.098,
      "t_ga_sigma_ms": 0.0193,
      "chi2_dof": 0.284,
      "p_IsinI_mm": [
        -122.81,
        -45.26,
        -3.06
      ],
      "rotvec": [
        2.25021,
        2.18493,
        -0.02792
      ],
      "Dw_diag": [
        0.99993,
        0.99978,
        1.00272
      ],
      "Da_diag": [
        0.99542,
        1.00114,
        1.00083
      ],
      "Dw_scale": [
        0.99994,
        0.99979,
        1.00272
      ],
      "Dw_shear": [
        -0.00066,
        -0.00144,
        0.0027
      ],
      "gyro_misalign_rotvec": [
        0.003839,
        -0.000694,
        -0.000406
      ]
    },
    {
      "name": "gx3_35",
      "td_ms": -2.071,
      "t_ga_ms": 0.0093,
      "t_ga_sigma_ms": 0.0213,
      "chi2_dof": 0.31,
      "p_IsinI_mm": [
        -82.29,
        -46.18,
        -3.45
      ],
      "rotvec": [
        2.23039,
        2.20704,
        -0.01922
      ],
      "Dw_diag": [
        0.99902,
        0.99859,
        1.00086
      ],
      "Da_diag": [
        0.99487,
        1.00041,
        1.0006
      ],
      "Dw_scale": [
        0.99902,
        0.99859,
        1.00087
      ],
      "Dw_shear": [
        -0.00111,
        -0.00111,
        -0.00086
      ],
      "gyro_misalign_rotvec": [
        0.002251,
        -0.001324,
        -0.001584
      ]
    },
    {
      "name": "t265",
      "td_ms": -7.171,
      "t_ga_ms": -6.7401,
      "t_ga_sigma_ms": 0.0184,
      "chi2_dof": 0.669,
      "p_IsinI_mm": [
        54.73,
        -107.43,
        -30.34
      ],
      "rotvec": [
        1.57242,
        -0.00537,
        -0.01134
      ],
      "Dw_diag": [
        0.99666,
        1.00367,
        1.00278
      ],
      "Da_diag": [
        1.02054,
        1.02035,
        1.0123
      ],
      "Dw_scale": [
        0.99688,
        1.00367,
        1.00296
      ],
      "Dw_shear": [
        0.00101,
        0.0018,
        -0.00127
      ],
      "gyro_misalign_rotvec": [
        0.000467,
        -0.021022,
        -0.000712
      ]
    }
  ]
}

12. Configuration

Run configuration · YAML, 56 lines, copy-paste ready (click to expand)
input:
  format: ros1
  path: 4imus_4cams_01.bag
  cam_topics:
  - /t265/fisheye1/image_raw
  - /t265/fisheye2/image_raw
  - /elp/split_sync_image_node/left/image_raw
  - /elp/split_sync_image_node/right/image_raw
  imu_topics:
  - /imu/data
  - /gx3_25/data
  - /gx3_35/imu/data
  - /t265/imu
  window_mode: motion
  segment_length: 80.0
board:
  board_type: apriltag
  rows: 6
  cols: 6
  tag_size: 0.088
  tag_spacing: 0.3
  tag_family: t36h11
  heights_file: board_shape_4imus_4cams.yaml
camera_input:
  path: camera_prior.yaml
  cameras:
  - {}
  - factor_hz: 4.0
  - estimate_readout: true
    factor_hz: 4.0
  - estimate_readout: true
    factor_hz: 4.0
solve:
  max_iterations: 40
  corner_subsample: two_anti
  estimate_t_ga: true
  sigma_t_ga: 0.01
  vision_pose: imu
  sigma_g: 0.00065
  sigma_a: 0.0026
  sigma_bg: 0.001
  sigma_ba: 0.002
estimate:
  board_points: true
  camera:
    intrinsics: true
    tr: false
    td: true
    extrinsics: true
  imu:
    intrinsics: dw_da
    model: calyx
    extrinsics: true
    td: true
output:
  path: cam_imu.json