| Metric | Value | Grade |
|---|---|---|
| Reprojection median (px) | 0.2458 | ✓ good |
| Reprojection p95 (px) | 0.6789 | ✓ good |
| Camera χ²/dof | 0.133 | ✓ good |
| IMU χ²/dof | 0.137 | ✓ good |
| Trajectory states | 2398 | |
| LM iterations | 6 | |
| IMU model | calyx | |
| t_ga gyro→accel (ms) | -0.815 ± 0.023 |
| Camera | Mean (px) | Median (px) | P90 (px) | P95 (px) | Max (px) | Tags | Corners |
|---|---|---|---|---|---|---|---|
| cam0 | 0.324 | 0.253 | 0.556 | 0.736 | 22.1 | 23,064 | 46,128 |
| cam1 | 0.314 | 0.245 | 0.534 | 0.696 | 20.3 | 11,706 | 23,412 |
| cam2 | 0.272 | 0.230 | 0.464 | 0.562 | 8.8 | 6,998 | 13,996 |
| cam3 | 0.289 | 0.243 | 0.488 | 0.589 | 11.4 | 7,649 | 15,298 |
Per-corner error norms at the solution; guard-skipped corners left out; Tags = distinct tags seen per frame, summed over frames.
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.
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.
| cam | model | reproj med/p95 px | fx,fy,cx,cy | td ms | tr ms | lever |mm| | rot |rad| | baseline mm |
|---|---|---|---|---|---|---|---|---|
| cam0 | equidistant | 0.253 / 0.74 | 286.5, 286.3, 414.9, 402.6 | -5.411 | 0.000 (pin) | 130.82 | 3.13454 | — |
| cam1 | equidistant | 0.245 / 0.70 | 286.5, 286.1, 414.4, 397.0 | -7.470 | 0.000 (pin) | 112.24 | 3.13120 | 63.69 |
| cam2 | equidistant | 0.230 / 0.56 | 426.9, 426.4, 350.4, 265.9 | -123.249 | 16.682 | 145.12 | 3.08633 | 153.41 |
| cam3 | equidistant | 0.243 / 0.59 | 423.6, 423.1, 336.5, 256.9 | -123.300 | 16.729 | 185.96 | 3.09370 | 212.75 |
| cam0 — T_C→I | x | y | z | |·| |
|---|---|---|---|---|
| lever (mm) | 64.32 | -110.63 | -27.15 | 130.82 |
| lever σ (mm) | 0.13 | 0.15 | 0.30 | |
| rotation (rad) | -0.03181 | -2.21757 | 2.21512 | 3.13454 |
| rotation σ (rad) | 3.58e-04 | 3.13e-04 | 1.92e-04 |
| cam0 — temporal / distortion | value |
|---|---|
| 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 accounting | corners: 46128 used, 0 past fold, 0 other invalid; 2 no-pose frames, 0 outliers; max theta 73.4 deg |
| cam1 — T_C→I | x | y | z | |·| |
|---|---|---|---|---|
| lever (mm) | 0.66 | -108.91 | -27.15 | 112.24 |
| lever σ (mm) | 0.14 | 0.16 | 0.32 | |
| rotation (rad) | -0.03923 | -2.21241 | 2.21543 | 3.13120 |
| rotation σ (rad) | 4.47e-04 | 3.89e-04 | 1.95e-04 |
| cam1 — temporal / distortion | value |
|---|---|
| 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 accounting | corners: 23412 used, 0 past fold, 0 other invalid; 2 no-pose frames, 0 outliers; max theta 75.4 deg |
| cam2 — T_C→I | x | y | z | |·| |
|---|---|---|---|---|
| lever (mm) | -89.00 | -112.43 | -22.32 | 145.12 |
| lever σ (mm) | 0.13 | 0.15 | 0.32 | |
| rotation (rad) | -0.00383 | -2.08348 | 2.27695 | 3.08633 |
| rotation σ (rad) | 4.32e-04 | 4.81e-04 | 1.92e-04 |
| cam2 — temporal / distortion | value |
|---|---|
| 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 accounting | corners: 13996 used, 0 past fold, 0 other invalid; 3 no-pose frames, 0 outliers; max theta 56.6 deg |
| cam3 — T_C→I | x | y | z | |·| |
|---|---|---|---|---|
| lever (mm) | -148.34 | -110.18 | -20.89 | 185.96 |
| lever σ (mm) | 0.13 | 0.15 | 0.32 | |
| rotation (rad) | 0.01351 | -2.11292 | 2.25972 | 3.09370 |
| rotation σ (rad) | 4.04e-04 | 4.60e-04 | 1.93e-04 |
| cam3 — temporal / distortion | value |
|---|---|
| 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 accounting | corners: 15298 used, 0 past fold, 0 other invalid; 1 no-pose frames, 0 outliers; max theta 58.6 deg |
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.
| Metric | Value |
|---|---|
| Peak to peak (mm) | 8.97 |
| RMS (mm) | 2.21 |
| Corners seen | 72 of 144 |
| Median height σ (mm) | 0.43 |
| Camera | Mean (px) | Median (px) | P90 (px) | P95 (px) | Max (px) | Tags | Corners |
|---|---|---|---|---|---|---|---|
| cam0 | 0.324 | 0.253 | 0.556 | 0.736 | 22.1 | 23,064 | 46,128 |
| cam1 | 0.314 | 0.245 | 0.534 | 0.696 | 20.3 | 11,706 | 23,412 |
| cam2 | 0.272 | 0.230 | 0.464 | 0.562 | 8.8 | 6,998 | 13,996 |
| cam3 | 0.289 | 0.243 | 0.488 | 0.589 | 11.4 | 7,649 | 15,298 |
Per-corner error norms at the solution; guard-skipped corners left out; Tags = distinct tags seen per frame, summed over frames.
Body-frame angular velocity finite-differenced from the solved trajectory states — the excitation context for lever-arm / td observability.
| param | value |
|---|---|
| b_g | -0.01035 0.00249 -0.00188 |
| b_g drift | 0.00085 -0.00013 -0.00034 |
| b_a | 0.0006 -0.0357 0.0067 |
| b_a drift | 0.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) |
| +0.998130 | -0.000451 | +0.003038 |
| -0.000282 | +0.997679 | +0.002154 |
| -0.001083 | -0.001151 | +1.000896 |
| +0.999943 | -0.000770 | +0.000160 |
| +0.000000 | +0.996422 | -0.000937 |
| +0.000000 | +0.000000 | +1.001242 |
| +0.000000 | -0.000000 | +0.000000 |
| -0.000000 | +0.000000 | -0.000000 |
| +0.000000 | +0.000000 | -0.000000 |
Per-IMU parameters in the base-IMU format; the spatial (T_IstoI) and temporal (td) rows are relative to the base IMU.
| param | value |
|---|---|
| td vs base (ms) | -0.691 |
| t_ga gyro→accel (ms) | +0.098 ± 0.019 |
| χ²/dof | 0.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 |
| +0.999935 | -0.000259 | -0.002138 |
| -0.000407 | +0.999781 | -0.001152 |
| +0.000693 | +0.003838 | +1.002722 |
| +0.995418 | +0.001168 | +0.002355 |
| +0.000000 | +1.001142 | -0.002074 |
| +0.000000 | +0.000000 | +1.000833 |
| +0.000000 | -0.000000 | +0.000000 |
| +0.000000 | -0.000000 | +0.000000 |
| +0.000000 | -0.000000 | +0.000000 |
| param | value |
|---|---|
| td vs base (ms) | -2.071 |
| t_ga gyro→accel (ms) | +0.009 ± 0.021 |
| χ²/dof | 0.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_g | 0.00249 -0.00023 -0.00118 |
| b_a | -0.0372 0.0644 -0.0103 |
| +0.999016 | +0.000472 | -0.002434 |
| -0.001584 | +0.998589 | -0.003107 |
| +0.001321 | +0.002247 | +1.000860 |
| +0.994870 | +0.002013 | -0.000441 |
| +0.000000 | +1.000410 | -0.002310 |
| +0.000000 | +0.000000 | +1.000604 |
| +0.000000 | -0.000000 | -0.000000 |
| +0.000000 | -0.000000 | +0.000000 |
| +0.000000 | +0.000000 | +0.000000 |
| param | value |
|---|---|
| td vs base (ms) | -7.171 |
| t_ga gyro→accel (ms) | -6.740 ± 0.018 |
| χ²/dof | 0.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 |
| +0.996664 | +0.001718 | -0.019285 |
| -0.000715 | +1.003669 | -0.001728 |
| +0.020955 | +0.000497 | +1.002780 |
| +1.020538 | -0.008993 | -0.021823 |
| +0.000000 | +1.020345 | -0.000604 |
| +0.000000 | +0.000000 | +1.012303 |
| +0.000000 | -0.000000 | +0.000000 |
| +0.000000 | -0.000000 | +0.000000 |
| +0.000000 | -0.000000 | +0.000000 |
| residual rows | cost | share |
|---|---|---|
| theta | 1307.8 | 26.6% |
| p | 2400.3 | 48.8% |
| v | 834.2 | 16.9% |
| bg | 108.2 | 2.2% |
| ba | 271.1 | 5.5% |
| stage | s | share |
|---|---|---|
| init_s | 92.23 | 14.4% |
| aux_init_s | 0.43 | 0.1% |
| graph_build_s | 27.43 | 4.3% |
| pre_diag_s | 31.38 | 4.9% |
| solve_s | 398.02 | 62.4% |
| post_diag_s | 5.62 | 0.9% |
| marginals_s | 16.90 | 2.6% |
| per_iteration_s | 66.34 | 10.4% |
| total | 638.35 |
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
]
}
]
}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