PARAMS_SE3OFFSET 0 0 0 0 0 0 0 1
VERTEX_SE3:QUAT 1 18.7381 0.000000274428 8.2287 0.0 0.0 0.0 1.0
FIX 1
VERTEX_SE3:QUAT 2 -0.03412699999999802 2.2435900000000037 -0.5031229999999987 -0.12753305211809116 -0.02133060871703912 0.15010206134121926 0.9801784005630412
VERTEX_SE3:QUAT 3 0.138898999999995 2.431249999999995 -0.1575310000000032 0.0012179096055795063 -0.06375197935389815 0.008035817397597622 0.9979326768191358
VERTEX_SE3:QUAT 4 0.09418580000000887 2.244809999999994 -0.15805999999999631 -0.0907382160557472 -0.031199905520692607 0.023300404122908847 0.9951131760811078
VERTEX_SE3:QUAT 5 -0.0199679999999951 2.4387400000000055 -0.1410059999999982 0.14682005186654737 -0.016064405675009996 -0.009985983527709352 0.9889823493739398
EDGE_SE3_PRIOR 1 0 0.309576 2.34636 0.00315914 -0.139007 0.0806488 0.14657 0.976059 1.0 0.000000000000000000962965 0.000000000000000000962965 0.0000000588441 -0.0000000203096 0.00000000340337 1.0 0.000000000000000000962965 0.0000000588441 -0.0000000203096 0.00000000340337 1.0 0.0000000588441 -0.0000000203096 0.00000000340337 4108.72 -34.2982 884.091 3951.5 40.2084 4100.08
EDGE_SE3_PRIOR 2 0 -0.034127 2.24359 -0.503123 -0.127533 -0.0213306 0.150102 0.980178 1.0 0.0 0.0 0.0 0.0 0.0 1.0 0.0 0.0 0.0 0.0 1.0 0.0 0.0 0.0 3934.45 -9.14727 63.005 3998.72 10.7561 3909.38
EDGE_SE3_PRIOR 3 0 0.138899 2.43125 -0.157531 0.00121791 -0.063752 0.00803582 0.997933 1.0 0.0 0.0 0.0 0.0 0.0 1.0 0.0 0.0 0.0 0.0 1.0 0.0 0.0 0.0 4065.84 0.47106 -517.426 3983.74 -2.04693 4065.59
EDGE_SE3_PRIOR 4 0 0.0941858 2.24481 -0.15806 -0.0907382 -0.0311999 0.0233004 0.995113 1.0 0.0000000000000000000120371 0.0000000000000000000120371 0.000000000183689 0.000000000641125 -0.00000000691561 1.0 0.0000000000000000000120371 0.000000000183689 0.000000000641125 -0.00000000691561 1.0 0.000000000183689 0.000000000641125 -0.00000000691561 3979.28 10.1662 -221.62 3997.33 -4.26681 4010.04
EDGE_SE3_PRIOR 5 0 -0.019968 2.43874 -0.141006 0.14682 -0.0160644 -0.00998598 0.988982 1.0 0.000000000000000000773381 0.000000000000000000773381 -0.0000000549689 -0.00000000264098 0.00000000120286 1.0 0.000000000000000000773381 -0.0000000549689 -0.00000000264098 0.00000000120286 1.0 -0.0000000549689 -0.00000000264098 0.00000000120286 3916.62 -7.39114 -107.077 3999.45 1.19465 4002.45