Skip to content

Instantly share code, notes, and snippets.

View adthoms's full-sized avatar
🎯
Focusing

Alexander Thoms adthoms

🎯
Focusing
View GitHub Profile
@adthoms
adthoms / factor_graph_low_noise.pyfg
Created March 9, 2024 00:27
factor_graph_low_noise
EDGE_SE3:QUAT 0.000000000 X0 X1 0.127000000 -0.002188718 -0.000000000 0.000000000 0.000000000 0.000000000 1.000000000 0.000100000 0.0 0.0 0.0 0.0 0.0 0.000100000 0.0 0.0 0.0 0.0 0.000100000 0.0 0.0 0.0 0.000100000 0.0 0.0 0.000100000 0.0 0.000100000
EDGE_RANGE 0.000000000 X0 L0 4.694684269 0.000100000
EDGE_RANGE 0.000000000 X0 L1 4.665029454 0.000100000
EDGE_RANGE 0.000000000 X0 L2 4.323973794 0.000100000
EDGE_RANGE 0.000000000 X0 L3 4.430106543 0.000100000
EDGE_RANGE 0.000000000 X0 L4 4.114665988 0.000100000
EDGE_RANGE 0.000000000 X0 L5 4.035051528 0.000100000
EDGE_RANGE 0.000000000 X0 L6 5.075153618 0.000100000
EDGE_RANGE 0.000000000 X0 L7 5.047581534 0.000100000
EDGE_RANGE 0.000000000 X0 L8 4.734181365 0.000100000
@adthoms
adthoms / gist:1f8a3116d537b43ff2ba900edea61eaf
Last active March 10, 2024 04:54
factor_graph_2d_eight_landmarks_high_noise.pyfg
EDGE_SE2 0.000000000 X0 X1 0.450803136 0.000285191 0.000000000 0.01 0.0 0.0 0.01 0.0 0.01
EDGE_RANGE 0.000000000 X0 L0 0.901387819 0.01
EDGE_RANGE 0.000000000 X0 L1 0.901388114 0.01
EDGE_RANGE 0.000000000 X0 L6 3.782384875 0.01
EDGE_RANGE 0.000000000 X0 L7 3.579455266 0.01
EDGE_RANGE 0.500000000 X1 L0 1.295024750 0.01
EDGE_RANGE 0.500000000 X1 L1 1.206164147 0.01
EDGE_RANGE 0.500000000 X1 L6 3.867166037 0.01
EDGE_RANGE 0.500000000 X1 L7 3.697765941 0.01
EDGE_SE2 0.500000000 X1 X2 0.453387111 -0.000285191 0.000000000 0.01 0.0 0.0 0.01 0.0 0.01
@adthoms
adthoms / gist:23cb1515f6674edbbf166a562859d03a
Created March 10, 2024 04:54
factor_graph_2d_four_landmarks_high_noise.pyfg
EDGE_SE2 0.000000000 X0 X1 0.450803136 0.000285191 0.000000000 0.01 0.0 0.0 0.01 0.0 0.01
EDGE_RANGE 0.000000000 X0 L0 0.901387819 0.01
EDGE_RANGE 0.000000000 X0 L1 0.901388114 0.01
EDGE_RANGE 0.500000000 X1 L0 1.295024750 0.01
EDGE_RANGE 0.500000000 X1 L1 1.206164147 0.01
EDGE_SE2 0.500000000 X1 X2 0.453387111 -0.000285191 0.000000000 0.01 0.0 0.0 0.01 0.0 0.01
EDGE_RANGE 1.000000000 X2 L0 1.713037154 0.01
EDGE_RANGE 1.000000000 X2 L1 1.578402256 0.01
EDGE_SE2 1.000000000 X2 X3 0.429707247 0.000000000 0.000000000 0.01 0.0 0.0 0.01 0.0 0.01
EDGE_RANGE 1.500000000 X3 L0 2.142493355 0.01
@adthoms
adthoms / gist:c7cf804f57f1c1492a70e464aa1c8a56
Created March 12, 2024 02:15
factor_graph_2d_simple_anchor_inspection.pyfg
VERTEX_SE2 0.000000000 X0 1.007532748 1.004881460 0.000000000
VERTEX_SE2 0.500000000 X1 1.444444444 1.000000000 0.000000000
VERTEX_SE2 1.000000000 X2 2.079325921 0.994710667 0.000000000
VERTEX_SE2 1.500000000 X3 2.330165825 1.011821302 0.000000000
VERTEX_SE2 2.000000000 X4 2.646136607 1.648524173 0.000000000
VERTEX_SE2 2.500000000 X5 3.225331346 0.998837789 0.000000000
VERTEX_SE2 3.000000000 X6 2.797216089 -0.090557392 0.000000000
VERTEX_SE2 3.500000000 X7 3.229341247 0.253332540 0.000000000
VERTEX_SE2 4.000000000 X8 4.569993267 1.175023926 0.000000000
VERTEX_SE2 4.500000000 X9 5.002018751 0.997981249 0.000000000
@adthoms
adthoms / gist:37dbce6fe6d078a6f0bbb36869ea3892
Created March 12, 2024 23:24
/home/alex/catkin_ws/src/post_eq_inspection_exp/results/rr_0.020000_ra_0.001000_at_0.001000_tj_0.005000_range_10/trial_3/factor_graph.pyfg
EDGE_SE2_XY 0.000000000 J0 L0 0.000000000 0.250000000 25.000000000 0.0 25.000000000
EDGE_SE2_XY 0.000000000 J0 L1 0.250000000 0.000000000 25.000000000 0.0 25.000000000
EDGE_SE2_XY 0.500000000 J1 L2 -0.250000000 0.000000000 25.000000000 0.0 25.000000000
EDGE_SE2_XY 0.500000000 J1 L3 0.000000000 0.250000000 25.000000000 0.0 25.000000000
EDGE_SE2_XY 1.000000000 J2 L4 0.250000000 0.000000000 25.000000000 0.0 25.000000000
EDGE_SE2_XY 1.000000000 J2 L5 0.000000000 -0.250000000 25.000000000 0.0 25.000000000
EDGE_SE2_XY 1.500000000 J3 L6 0.000000000 -0.250000000 25.000000000 0.0 25.000000000
EDGE_SE2_XY 1.500000000 J3 L7 -0.250000000 0.000000000 25.000000000 0.0 25.000000000
EDGE_SE2_XY 2.000000000 J4 L8 0.000000000 0.250000000 25.000000000 0.0 25.000000000
EDGE_SE2_XY 2.000000000 J4 L9 0.250000000 0.000000000 25.000000000 0.0 25.000000000
@adthoms
adthoms / gist:d78214cad362b9a9d501921f7b19ad3c
Created April 3, 2024 00:40
cora_high_precisions_numerical_errors_factor_graph_low_noise.pyfg
Solving data/factor_graph_low_noise.pyfg
WARNING: Logging iterates will slow down the optimization process. This is intended for debugging and viz purposes only.
Solving problem at rank 4
Obtained solution with objective value: 45.395533
Result is certified: 0 with eta: 0.000045 and theta: -0.033148
Solving problem at rank 5
Obtained solution with objective value: 41.882193
Result is certified: 0 with eta: 0.000042 and theta: -0.004848