This file contains bidirectional Unicode text that may be interpreted or compiled differently than what appears below. To review, open the file in an editor that reveals hidden Unicode characters.
Learn more about bidirectional Unicode characters
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 |
This file contains bidirectional Unicode text that may be interpreted or compiled differently than what appears below. To review, open the file in an editor that reveals hidden Unicode characters.
Learn more about bidirectional Unicode characters
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 |
This file contains bidirectional Unicode text that may be interpreted or compiled differently than what appears below. To review, open the file in an editor that reveals hidden Unicode characters.
Learn more about bidirectional Unicode characters
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 |
This file contains bidirectional Unicode text that may be interpreted or compiled differently than what appears below. To review, open the file in an editor that reveals hidden Unicode characters.
Learn more about bidirectional Unicode characters
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 |
This file contains bidirectional Unicode text that may be interpreted or compiled differently than what appears below. To review, open the file in an editor that reveals hidden Unicode characters.
Learn more about bidirectional Unicode characters
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 |
This file contains bidirectional Unicode text that may be interpreted or compiled differently than what appears below. To review, open the file in an editor that reveals hidden Unicode characters.
Learn more about bidirectional Unicode characters
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 |