+ python -m lidar_slam --no-model /working/2a0f8b05-a80d-4ee5-a69a-b455562b8d63 Lidar SLAM 0.0.12 ===================================================== The recording path: /working/2a0f8b05-a80d-4ee5-a69a-b455562b8d63 The start distance for SLAM: 0.0 The end distance for SLAM: 9.223372036854776e+18 The step lidar is being SLAMMed with: 0.03 Using the pointcloud ICP: False The Lidar frames will be flattened: False The centerline will be flattened: False The Lidar 2D slices will be flipped: True Correction angle of Lidar frames: 0.0 Show the detected centerline?: False Display the final 3D model?: False Making 2D slices out of SLAM model?: False Drop angle of 2D slices: 45.0 The number of points in 2D slices: 360 ===================================================== Adjusted start_distance from 0.0 to 0.001463509 Adjusted end_distance from 9.223372036854776e+18 to 13.534583509 -=-=-> Lidar cleaning parameters file not found. --> Creating a generic default one. SLAMing on 0.001463509 meters 0.26025124187557774 Centerline is valid? [0, False] SLAMing on 0.031463509 meters 0.3223053859441046 Centerline is valid? [False, False] Translation: X:-0.05, Y:0.00, Z:0.00 [[ 0.99966271 0.02560343 0.00435094 -0.04850437] [-0.02562386 0.99966058 0.00470541 0.00186314] [-0.00422899 -0.00481531 0.99997946 0.00197786] [ 0. 0. 0. 1. ]] SLAMing on 0.061463509 meters 0.31789605230909784 Centerline is valid? [False, False] Translation: X:-0.07, Y:-0.01, Z:-0.00 [[ 9.99895129e-01 5.43893986e-03 1.34219505e-02 -7.40356577e-02] [-5.52011867e-03 9.99966652e-01 6.01859524e-03 -5.03856720e-03] [-1.33887681e-02 -6.09205482e-03 9.99891808e-01 -2.64158033e-04] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 0.091463509 meters 0.3169058408428915 Centerline is valid? [False, False] Translation: X:-0.12, Y:0.00, Z:0.00 [[ 0.99985086 -0.00224686 0.01712348 -0.11875756] [ 0.00228557 0.99999488 -0.00224182 0.00498862] [-0.01711835 0.00228062 0.99985087 0.0045776 ] [ 0. 0. 0. 1. ]] SLAMing on 0.121463509 meters 0.2560417987091564 Centerline is valid? [False, False] Translation: X:-0.10, Y:-0.01, Z:0.01 [[ 0.99992292 -0.00168996 0.01230041 -0.10004229] [ 0.00179043 0.99996509 -0.00816163 -0.00914655] [-0.01228619 0.00818302 0.99989104 0.00618255] [ 0. 0. 0. 1. ]] SLAMing on 0.151463509 meters 0.20089797605439383 Centerline is valid? [False, False] Translation: X:-0.07, Y:-0.01, Z:0.01 [[ 0.99989003 -0.01454776 -0.00287823 -0.0742688 ] [ 0.01447791 0.99963154 -0.02296028 -0.0054388 ] [ 0.00321119 0.02291608 0.99973223 0.0117839 ] [ 0. 0. 0. 1. ]] SLAMing on 0.181463509 meters 0.1467429903505084 Centerline is valid? [False, False] Translation: X:-0.06, Y:0.02, Z:0.04 [[ 0.99974389 0.0187093 -0.01273213 -0.06346124] [-0.01903305 0.99948591 -0.02580038 0.01795529] [ 0.01224288 0.0260361 0.99958603 0.03683609] [ 0. 0. 0. 1. ]] SLAMing on 0.211463509 meters 0.07506156258020914 Centerline is valid? [False, True] Translation: X:-0.06, Y:0.02, Z:0.02 [[ 9.87907191e-01 1.54587273e-01 1.19229749e-02 -5.66007230e-02] [-1.54579979e-01 9.87979083e-01 -1.53652276e-03 2.17906361e-02] [-1.20171766e-02 -3.25111312e-04 9.99927738e-01 2.49131652e-02] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 0.241463509 meters 0.017983632393804638 Centerline is valid? [True, True] Translation: X:-0.30, Y:0.39, Z:-4.40 [[ 7.68299732e-01 6.39464456e-01 2.82971993e-02 -2.98483081e-01] [ 6.39117572e-01 -7.68818452e-01 2.11404010e-02 3.85221715e-01] [ 3.52739440e-02 1.84307288e-03 -9.99375981e-01 -4.40460030e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 0.271463509 meters 0.01755203828577099 Centerline is valid? [True, True] Translation: X:-0.33, Y:0.38, Z:-4.41 [[ 7.13104347e-01 7.00430746e-01 2.96472625e-02 -3.29768720e-01] [ 6.99949187e-01 -7.13717077e-01 2.60589583e-02 3.82928759e-01] [ 3.94122531e-02 2.16882086e-03 -9.99220682e-01 -4.41448147e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 0.30146350899999996 meters 0.022878241109959722 Centerline is valid? [True, True] Translation: X:-0.34, Y:0.36, Z:-4.48 [[ 6.34051386e-01 7.72700010e-01 3.02247266e-02 -3.40136786e-01] [ 7.72080434e-01 -6.34761228e-01 3.11446257e-02 3.60504408e-01] [ 4.32509372e-02 3.58862695e-03 -9.99057795e-01 -4.48275211e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 0.33146350899999993 meters 0.023143485286277864 Centerline is valid? [True, True] Translation: X:-0.37, Y:0.36, Z:-4.56 [[ 0.56033936 0.82769822 0.03058513 -0.36682101] [ 0.82688503 -0.56115479 0.03696556 0.35756687] [ 0.04775932 0.00457713 -0.99884839 -4.55793272] [ 0. 0. 0. 1. ]] SLAMing on 0.36146350899999996 meters 0.018125667398974372 Centerline is valid? [True, True] Translation: X:-0.43, Y:0.38, Z:-4.59 [[ 5.27364253e-01 8.49074692e-01 3.09695318e-02 -4.25458721e-01] [ 8.47932485e-01 -5.28264361e-01 4.41278345e-02 3.76689541e-01] [ 5.38279274e-02 2.98862962e-03 -9.98545754e-01 -4.59317124e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 0.391463509 meters 0.019888802439459095 Centerline is valid? [True, True] Translation: X:-0.54, Y:0.42, Z:-4.78 [[ 5.44428069e-01 8.38619045e-01 1.77813007e-02 -5.35554544e-01] [ 8.38087984e-01 -5.44716666e-01 2.98711252e-02 4.18078513e-01] [ 3.47362653e-02 -1.36038452e-03 -9.99395588e-01 -4.77832338e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 0.42146350899999996 meters 0.027464862364947412 Centerline is valid? [True, True] Translation: X:-0.62, Y:0.43, Z:-5.00 [[ 5.20275269e-01 8.53940366e-01 9.97477480e-03 -6.18811398e-01] [ 8.53709533e-01 -5.20367558e-01 1.99408731e-02 4.28695530e-01] [ 2.22188657e-02 -1.85918279e-03 -9.99751402e-01 -5.00018218e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 0.45146350899999993 meters 0.03129743778398604 Centerline is valid? [True, True] Translation: X:-0.62, Y:0.38, Z:-1.26 [[ 3.27756286e-01 -9.44758651e-01 2.62844856e-03 -6.19937521e-01] [ 9.44743098e-01 3.27766094e-01 5.46500574e-03 3.75104271e-01] [-6.02462777e-03 6.92018650e-04 9.99981612e-01 -1.26323187e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 0.48146350899999996 meters 0.032583171360226065 Centerline is valid? [True, True] Translation: X:-0.61, Y:0.33, Z:-1.25 [[ 3.29860016e-01 -9.44029219e-01 -1.09730401e-03 -6.06456372e-01] [ 9.44026512e-01 3.29861719e-01 -2.27848399e-03 3.31594426e-01] [ 2.51291404e-03 -2.84303309e-04 9.99996802e-01 -1.25409017e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 0.511463509 meters 0.036110155195674426 Centerline is valid? [True, True] Translation: X:-0.60, Y:0.29, Z:-1.40 [[ 3.33235938e-01 -9.42843469e-01 -4.72447134e-05 -5.98095171e-01] [ 9.42843465e-01 3.33235941e-01 -9.40331635e-05 2.91663494e-01] [ 1.04402191e-04 -1.32091398e-05 9.99999994e-01 -1.39968810e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 0.5414635090000001 meters 0.03873322138521742 Centerline is valid? [True, True] Translation: X:-0.59, Y:0.25, Z:-1.61 [[ 3.32763544e-01 -9.43009253e-01 1.40451364e-03 -5.88121875e-01] [ 9.43004757e-01 3.32766325e-01 2.93262577e-03 2.51635172e-01] [-3.23286808e-03 3.48592101e-04 9.99994714e-01 -1.60816824e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 0.571463509 meters 0.03154855482404284 Centerline is valid? [True, True] Translation: X:-0.61, Y:0.23, Z:-1.66 [[ 3.21894342e-01 -9.46768434e-01 3.68313233e-03 -6.08619298e-01] [ 9.46737713e-01 3.21913827e-01 7.69355054e-03 2.26339020e-01] [-8.46966202e-03 1.01044988e-03 9.99963621e-01 -1.65828828e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 0.601463509 meters 0.033675609915856254 Centerline is valid? [True, True] Translation: X:-0.58, Y:0.17, Z:-1.57 [[ 3.37788732e-01 -9.41218128e-01 -2.68481868e-03 -5.76102271e-01] [ 9.41201645e-01 3.37798808e-01 -5.60617508e-03 1.73601526e-01] [ 6.18356216e-03 -6.33252984e-04 9.99980681e-01 -1.56551970e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 0.631463509 meters 0.018435024423985227 Centerline is valid? [True, True] Translation: X:-0.56, Y:0.13, Z:-1.75 [[ 3.94342223e-01 -9.18799242e-01 -1.73828747e-02 -5.57203377e-01] [ 9.18081691e-01 3.94721805e-01 -3.63415241e-02 1.29747164e-01] [ 4.02519645e-02 -1.62790159e-03 9.99188235e-01 -1.75009533e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 0.661463509 meters 0.02195724249651641 Centerline is valid? [True, True] Translation: X:-0.54, Y:0.09, Z:-1.73 [[ 0.37048834 -0.9287426 -0.01325056 -0.54445236] [ 0.92833092 0.37071966 -0.02772431 0.0864633 ] [ 0.03066099 -0.00202938 0.99952778 -1.72623854] [ 0. 0. 0. 1. ]] SLAMing on 0.691463509 meters 0.02280685634670041 Centerline is valid? [True, True] Translation: X:-0.52, Y:0.04, Z:-1.74 [[ 0.36134687 -0.93232886 -0.01383248 -0.52428009] [ 0.9318819 0.36160341 -0.02896711 0.0400946 ] [ 0.03200875 -0.00242306 0.99948465 -1.7424338 ] [ 0. 0. 0. 1. ]] SLAMing on 0.721463509 meters 0.0230494125743228 Centerline is valid? [True, True] Translation: X:-0.51, Y:-0.00, Z:-1.79 [[ 3.51275436e-01 -9.36167893e-01 -1.39729812e-02 -5.14295844e-01] [ 9.35713842e-01 3.51542186e-01 -2.92864644e-02 -9.79063660e-04] [ 3.23291400e-02 -2.78709635e-03 9.99473391e-01 -1.79378369e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 0.751463509 meters 0.03021228491123524 Centerline is valid? [True, True] Translation: X:-0.51, Y:-0.04, Z:-1.96 [[ 0.30103491 -0.95353998 -0.01181098 -0.50690513] [ 0.95322559 0.30124255 -0.02477709 -0.04020146] [ 0.02718392 -0.00379976 0.99962323 -1.96131393] [ 0. 0. 0. 1. ]] SLAMing on 0.7814635090000001 meters 0.037692461809763975 Centerline is valid? [True, True] Translation: X:-0.49, Y:-0.08, Z:-2.00 [[ 0.2630371 -0.96473371 -0.01001792 -0.49045476] [ 0.96451317 0.26319541 -0.02103627 -0.08329698] [ 0.02293107 -0.0041291 0.99972852 -1.99939544] [ 0. 0. 0. 1. ]] SLAMing on 0.811463509 meters 0.04614874089951301 Centerline is valid? [True, True] Translation: X:-0.50, Y:-0.12, Z:-2.03 [[ 0.26137642 -0.96516397 -0.01186949 -0.5000466 ] [ 0.96485398 0.26159933 -0.0249516 -0.11543292] [ 0.02718744 -0.00493056 0.99961819 -2.02953141] [ 0. 0. 0. 1. ]] SLAMing on 0.841463509 meters 0.03350484623229728 Centerline is valid? [True, True] Translation: X:-0.56, Y:-0.12, Z:-1.99 [[ 0.30671344 -0.95163828 -0.01764815 -0.56174056] [ 0.95092868 0.30717343 -0.03713658 -0.12267572] [ 0.04076164 -0.00539185 0.99915435 -1.98785337] [ 0. 0. 0. 1. ]] SLAMing on 0.871463509 meters 0.028027673626551317 Centerline is valid? [True, True] Translation: X:-0.62, Y:-0.13, Z:-1.96 [[ 0.33599102 -0.94169768 -0.01776258 -0.62481149] [ 0.94096345 0.33643469 -0.0374097 -0.12828385] [ 0.04120457 -0.00414462 0.99914213 -1.9579606 ] [ 0. 0. 0. 1. ]] SLAMing on 0.9014635089999999 meters 0.02575485333263622 Centerline is valid? [True, True] Translation: X:-0.65, Y:-0.15, Z:-1.95 [[ 0.35149818 -0.93601754 -0.01789391 -0.65271974] [ 0.93526381 0.35193617 -0.03771652 -0.15259153] [ 0.04160084 -0.00347823 0.99912826 -1.95200499] [ 0. 0. 0. 1. ]] SLAMing on 0.931463509 meters 0.012664043811472615 Centerline is valid? [True, True] Translation: X:-0.70, Y:-0.16, Z:-1.92 [[ 4.13444229e-01 -9.10172792e-01 -2.54825083e-02 -7.04541614e-01] [ 9.08584396e-01 4.14227750e-01 -5.37565456e-02 -1.63545535e-01] [ 5.94833072e-02 -9.27675840e-04 9.98228869e-01 -1.91833279e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 0.961463509 meters 0.012664043811472615 Centerline is valid? [True, True] Translation: X:-0.72, Y:-0.19, Z:-1.92 [[ 4.13018580e-01 -9.10366710e-01 -2.54579182e-02 -7.18758940e-01] [ 9.08777965e-01 4.13801391e-01 -5.37681948e-02 -1.92752249e-01] [ 5.94832966e-02 -9.28331663e-04 9.98228869e-01 -1.91847136e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 0.991463509 meters 0.014020672636963842 Centerline is valid? [True, True] Translation: X:-0.75, Y:-0.21, Z:-1.88 [[ 4.10493457e-01 -9.11539353e-01 -2.43131675e-02 -7.54820523e-01] [ 9.10090422e-01 4.11211551e-01 -5.13856391e-02 -2.10465361e-01] [ 5.68378875e-02 -1.03371226e-03 9.98382885e-01 -1.87854490e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 1.021463509 meters 0.014184534041454986 Centerline is valid? [True, True] Translation: X:-0.78, Y:-0.23, Z:-1.89 [[ 4.24094019e-01 -9.05304173e-01 -2.38457183e-02 -7.84718498e-01] [ 9.03897061e-01 4.24763853e-01 -5.04556420e-02 -2.31683916e-01] [ 5.58065024e-02 -1.56138696e-04 9.98441591e-01 -1.89423319e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 1.051463509 meters 0.015033314546676398 Centerline is valid? [True, True] Translation: X:-0.82, Y:-0.25, Z:-1.84 [[ 4.37517665e-01 -8.98866013e-01 -2.48633101e-02 -8.22092629e-01] [ 8.97321939e-01 4.38222950e-01 -5.26686269e-02 -2.49783309e-01] [ 5.82377117e-02 7.33061009e-04 9.98302475e-01 -1.84423224e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 1.081463509 meters 0.01434399111852642 Centerline is valid? [True, True] Translation: X:-0.85, Y:-0.27, Z:-1.98 [[ 4.38761099e-01 -8.98318734e-01 -2.26307310e-02 -8.48129549e-01] [ 8.97037214e-01 4.39343707e-01 -4.79723283e-02 -2.72342174e-01] [ 5.30371104e-02 7.47783646e-04 9.98592262e-01 -1.98081918e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 1.1114635089999998 meters 0.0146718091929222 Centerline is valid? [True, True] Translation: X:-0.87, Y:-0.30, Z:-2.05 [[ 4.31341009e-01 -9.01835693e-01 -2.52451300e-02 -8.68849249e-01] [ 9.00244318e-01 4.32078978e-01 -5.35530045e-02 -2.99162074e-01] [ 5.92039010e-02 3.72822126e-04 9.98245841e-01 -2.04831238e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 1.1414635089999998 meters 0.013792641392097878 Centerline is valid? [True, True] Translation: X:-0.89, Y:-0.32, Z:-1.99 [[ 4.29314800e-01 -9.02956922e-01 -1.89102805e-02 -8.92181640e-01] [ 9.02064246e-01 4.29731039e-01 -4.01413782e-02 -3.23055340e-01] [ 4.43722698e-02 1.74999900e-04 9.99015050e-01 -1.99279136e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 1.1714635089999998 meters 0.012871086076959392 Centerline is valid? [True, True] Translation: X:-0.92, Y:-0.35, Z:-2.00 [[ 4.18677808e-01 -9.07895807e-01 -2.08350155e-02 -9.20554411e-01] [ 9.06815569e-01 4.19195751e-01 -4.42769245e-02 -3.45762863e-01] [ 4.89327841e-02 -3.55750794e-04 9.98802010e-01 -1.99605364e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 1.2014635089999999 meters 0.012755588985091184 Centerline is valid? [True, True] Translation: X:-0.94, Y:-0.37, Z:-1.94 [[ 4.33211030e-01 -9.01096073e-01 -1.88167483e-02 -9.36921136e-01] [ 9.00206505e-01 4.33619308e-01 -4.00317847e-02 -3.73876742e-01] [ 4.42317894e-02 4.03251441e-04 9.99021214e-01 -1.93994303e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 1.231463509 meters 0.013887841536391695 Centerline is valid? [True, True] Translation: X:-0.95, Y:-0.40, Z:-1.96 [[ 4.14736974e-01 -9.09719292e-01 -2.01010367e-02 -9.54274602e-01] [ 9.08711514e-01 4.15223492e-01 -4.28116401e-02 -4.00788229e-01] [ 4.72929976e-02 -5.10473475e-04 9.98880930e-01 -1.96070363e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 1.261463509 meters 0.013658451308665179 Centerline is valid? [True, True] Translation: X:-0.96, Y:-0.43, Z:-1.97 [[ 4.19184440e-01 -9.07675380e-01 -2.02437804e-02 -9.64059395e-01] [ 9.06648357e-01 4.19672894e-01 -4.31673268e-02 -4.32018582e-01] [ 4.76776856e-02 -2.58918534e-04 9.98862739e-01 -1.96734838e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 1.291463509 meters 0.013810884682676838 Centerline is valid? [True, True] Translation: X:-0.98, Y:-0.46, Z:-1.95 [[ 4.13512356e-01 -9.10312307e-01 -1.84129068e-02 -9.80715235e-01] [ 9.09463412e-01 4.13921806e-01 -3.93070045e-02 -4.60137513e-01] [ 4.34031536e-02 -4.91933041e-04 9.99057518e-01 -1.94575815e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 1.3214635089999998 meters 0.01703507040904193 Centerline is valid? [True, True] Translation: X:-0.99, Y:-0.49, Z:-2.00 [[ 3.97998510e-01 -9.17188988e-01 -1.90143705e-02 -9.86921681e-01] [ 9.16288566e-01 3.98450515e-01 -4.06503453e-02 -4.93016223e-01] [ 4.48603348e-02 -1.24387348e-03 9.98992494e-01 -1.99711023e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 1.3514635089999998 meters 0.012752993360449686 Centerline is valid? [True, True] Translation: X:-1.00, Y:-0.52, Z:-1.98 [[ 4.10800674e-01 -9.11505589e-01 -2.00091738e-02 -1.00176350e+00] [ 9.10498463e-01 4.11287220e-01 -4.28412397e-02 -5.21510534e-01] [ 4.72795469e-02 -6.19111854e-04 9.98881505e-01 -1.97626138e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 1.3814635089999998 meters 0.013358597738056184 Centerline is valid? [True, True] Translation: X:-1.02, Y:-0.55, Z:-1.99 [[ 4.11607141e-01 -9.11044184e-01 -2.40428070e-02 -1.01655468e+00] [ 9.09584551e-01 4.12308227e-01 -5.15545385e-02 -5.51089439e-01] [ 5.68815096e-02 -6.48749647e-04 9.98380725e-01 -1.98555698e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 1.4114635089999998 meters 0.01290768831570307 Centerline is valid? [True, True] Translation: X:-1.02, Y:-0.58, Z:-1.98 [[ 4.09216296e-01 -9.12241366e-01 -1.89132902e-02 -1.02374561e+00] [ 9.11337025e-01 4.09652670e-01 -4.06142457e-02 -5.84196924e-01] [ 4.47978748e-02 -6.16370443e-04 9.98995881e-01 -1.97914352e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 1.4414635089999999 meters 0.01583214137346075 Centerline is valid? [True, True] Translation: X:-1.04, Y:-0.61, Z:-1.98 [[ 4.01928724e-01 -9.15363307e-01 -2.37343167e-02 -1.04089880e+00] [ 9.13941017e-01 4.02627139e-01 -5.10216048e-02 -6.12913423e-01] [ 5.62593849e-02 -1.18471705e-03 9.98415484e-01 -1.97633030e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 1.471463509 meters 0.016229312098430298 Centerline is valid? [True, True] Translation: X:-1.05, Y:-0.65, Z:-1.96 [[ 3.94678279e-01 -9.18603027e-01 -1.99382974e-02 -1.04603818e+00] [ 9.17601030e-01 3.95179246e-01 -4.29151847e-02 -6.45125284e-01] [ 4.73012198e-02 -1.35771100e-03 9.98879748e-01 -1.95712763e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 1.501463509 meters 0.018942072972593725 Centerline is valid? [True, True] Translation: X:-1.06, Y:-0.67, Z:-1.97 [[ 3.90795817e-01 -9.20147605e-01 -2.46376546e-02 -1.06187735e+00] [ 9.18615672e-01 3.91567179e-01 -5.31073531e-02 -6.74312392e-01] [ 5.85139007e-02 -1.87840418e-03 9.98284827e-01 -1.97482440e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 1.531463509 meters 0.017511678082005242 Centerline is valid? [True, True] Translation: X:-1.07, Y:-0.71, Z:-1.95 [[ 3.91015718e-01 -9.20154931e-01 -2.05331775e-02 -1.06985121e+00] [ 9.19088320e-01 3.91551432e-01 -4.43185672e-02 -7.05782186e-01] [ 4.88197431e-02 -1.54254721e-03 9.98806414e-01 -1.94779055e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 1.561463509 meters 0.01923974005679511 Centerline is valid? [True, True] Translation: X:-1.08, Y:-0.74, Z:-1.98 [[ 3.88046730e-01 -9.21324584e-01 -2.40986632e-02 -1.07972933e+00] [ 9.19853006e-01 3.88789391e-01 -5.20889360e-02 -7.37091122e-01] [ 5.73601219e-02 -1.95428653e-03 9.98351640e-01 -1.98178328e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 1.5914635089999998 meters 0.021341451615981572 Centerline is valid? [True, True] Translation: X:-1.09, Y:-0.77, Z:-1.96 [[ 0.37407126 -0.9271931 -0.01958707 -1.09030833] [ 0.92622645 0.37457674 -0.04238907 -0.76732049] [ 0.04663971 -0.00228553 0.99890916 -1.95733267] [ 0. 0. 0. 1. ]] SLAMing on 1.6214635089999998 meters 0.02412002465706391 Centerline is valid? [True, True] Translation: X:-1.09, Y:-0.80, Z:-1.93 [[ 0.36671125 -0.93010226 -0.02080034 -1.09346456] [ 0.92901434 0.36729001 -0.04505988 -0.80309694] [ 0.04955005 -0.00279985 0.99876772 -1.92768211] [ 0. 0. 0. 1. ]] SLAMing on 1.6514635089999998 meters 0.018136899942319623 Centerline is valid? [True, True] Translation: X:-1.11, Y:-0.83, Z:-1.94 [[ 0.37635871 -0.92621719 -0.02181365 -1.1090922 ] [ 0.92501107 0.37698288 -0.047312 -0.83028772] [ 0.05204456 -0.00237159 0.99864195 -1.93614321] [ 0. 0. 0. 1. ]] SLAMing on 1.6814635089999999 meters 0.021468375000590616 Centerline is valid? [True, True] Translation: X:-1.12, Y:-0.86, Z:-1.94 [[ 0.36581736 -0.9304614 -0.02047526 -1.11641422] [ 0.92940229 0.36637951 -0.04446834 -0.86317362] [ 0.04887779 -0.00276246 0.99880095 -1.93706195] [ 0. 0. 0. 1. ]] SLAMing on 1.7114635089999999 meters 0.019607297976204602 Centerline is valid? [True, True] Translation: X:-1.12, Y:-0.90, Z:-1.94 [[ 0.3687329 -0.92928129 -0.02173302 -1.11613608] [ 0.92808279 0.36936263 -0.04726078 -0.89897099] [ 0.05194593 -0.00274344 0.99864613 -1.93608306] [ 0. 0. 0. 1. ]] SLAMing on 1.741463509 meters 0.020085813888865565 Centerline is valid? [True, True] Translation: X:-1.13, Y:-0.93, Z:-1.92 [[ 0.36579566 -0.9304529 -0.02123513 -1.1262037 ] [ 0.92930776 0.36640065 -0.04623473 -0.92994364] [ 0.0507998 -0.00282151 0.99870487 -1.92151871] [ 0. 0. 0. 1. ]] SLAMing on 1.771463509 meters 0.027575293171690274 Centerline is valid? [True, True] Translation: X:-1.13, Y:-0.97, Z:-1.95 [[ 0.34083987 -0.93994717 -0.01809712 -1.12631609] [ 0.93912623 0.34130147 -0.03943654 -0.96611286] [ 0.04324483 -0.00355393 0.99905818 -1.9540833 ] [ 0. 0. 0. 1. ]] SLAMing on 1.8014635089999997 meters 0.027469954143703224 Centerline is valid? [True, True] Translation: X:-1.13, Y:-1.00, Z:-1.96 [[ 0.3394067 -0.94045452 -0.01866523 -1.13069465] [ 0.93957985 0.33989923 -0.04072117 -1.0000067 ] [ 0.0446407 -0.00371644 0.99899619 -1.95871846] [ 0. 0. 0. 1. ]] SLAMing on 1.8314635089999998 meters 0.029906760591302695 Centerline is valid? [True, True] Translation: X:-1.13, Y:-1.04, Z:-1.95 [[ 0.32743865 -0.94471832 -0.01706518 -1.1314634 ] [ 0.94399113 0.32785976 -0.0372656 -1.03681929] [ 0.04080048 -0.00390718 0.99915967 -1.95151663] [ 0. 0. 0. 1. ]] SLAMing on 1.8614635089999998 meters 0.03034771500906488 Centerline is valid? [True, True] Translation: X:-1.14, Y:-1.07, Z:-1.97 [[ 0.33185661 -0.94314118 -0.01886563 -1.13503036] [ 0.94224766 0.33236728 -0.04124716 -1.07167859] [ 0.04517222 -0.00408795 0.99897085 -1.96975752] [ 0. 0. 0. 1. ]] SLAMing on 1.8914635089999998 meters 0.03601384492689393 Centerline is valid? [True, True] Translation: X:-1.13, Y:-1.11, Z:-1.94 [[ 0.31267454 -0.94972604 -0.01597115 -1.13451828] [ 0.94909213 0.3130536 -0.03495104 -1.10897878] [ 0.03819374 -0.0042298 0.9992614 -1.93822932] [ 0. 0. 0. 1. ]] SLAMing on 1.9214635089999998 meters 0.03090169687139036 Centerline is valid? [True, True] Translation: X:-1.14, Y:-1.14, Z:-1.97 [[ 0.32087173 -0.94691951 -0.01961581 -1.14404471] [ 0.94595631 0.32143537 -0.04296455 -1.13995134] [ 0.04698919 -0.00476959 0.99888401 -1.97133185] [ 0. 0. 0. 1. ]] SLAMing on 1.9514635089999999 meters 0.02929850238285243 Centerline is valid? [True, True] Translation: X:-1.15, Y:-1.17, Z:-1.95 [[ 0.33043742 -0.94361352 -0.02011552 -1.1487217 ] [ 0.94259191 0.3310201 -0.04411558 -1.17490003] [ 0.0482867 -0.00438329 0.9988239 -1.95481439] [ 0. 0. 0. 1. ]] SLAMing on 1.981463509 meters 0.028474489810612114 Centerline is valid? [True, True] Translation: X:-1.16, Y:-1.20, Z:-1.97 [[ 0.32578224 -0.94521689 -0.02075942 -1.16089198] [ 0.94412909 0.32640843 -0.04558276 -1.20484194] [ 0.04986164 -0.00474952 0.99874484 -1.96944437] [ 0. 0. 0. 1. ]] SLAMing on 2.011463509 meters 0.032579876787618 Centerline is valid? [True, True] Translation: X:-1.16, Y:-1.24, Z:-1.96 [[ 0.30855134 -0.95105038 -0.01729874 -1.15926811] [ 0.95030176 0.30900002 -0.03802027 -1.24203557] [ 0.04150451 -0.00470782 0.99912723 -1.96276059] [ 0. 0. 0. 1. ]] SLAMing on 2.041463509 meters 0.03409015479906943 Centerline is valid? [True, True] Translation: X:-1.18, Y:-1.27, Z:-1.97 [[ 0.30044859 -0.95364497 -0.0170858 -1.17736029] [ 0.9529166 0.30089271 -0.03759683 -1.26940408] [ 0.04099502 -0.00498543 0.99914691 -1.97461558] [ 0. 0. 0. 1. ]] SLAMing on 2.071463509 meters 0.031119609398725274 Centerline is valid? [True, True] Translation: X:-1.18, Y:-1.31, Z:-1.98 [[ 0.31408524 -0.9491913 -0.01965535 -1.17644292] [ 0.94821694 0.31465929 -0.04329172 -1.30619527] [ 0.04727686 -0.00504024 0.99886911 -1.98013517] [ 0. 0. 0. 1. ]] SLAMing on 2.1014635090000002 meters 0.03407794631274617 Centerline is valid? [True, True] Translation: X:-1.18, Y:-1.34, Z:-1.97 [[ 0.30808453 -0.95118548 -0.01816879 -1.18366495] [ 0.95035407 0.30858053 -0.040065 -1.33929245] [ 0.04371578 -0.00492337 0.99903188 -1.96953995] [ 0. 0. 0. 1. ]] SLAMing on 2.131463509 meters 0.0336674818523708 Centerline is valid? [True, True] Translation: X:-1.21, Y:-1.36, Z:-1.98 [[ 0.30395524 -0.95251852 -0.01787965 -1.20655258] [ 0.95171346 0.30443931 -0.0394741 -1.36474815] [ 0.04304308 -0.00501794 0.99906062 -1.97874522] [ 0. 0. 0. 1. ]] SLAMing on 2.1614635090000003 meters 0.03281525526381378 Centerline is valid? [True, True] Translation: X:-1.21, Y:-1.40, Z:-1.98 [[ 0.31004397 -0.95053884 -0.01867222 -1.21047182] [ 0.94965508 0.31056651 -0.04127548 -1.39952596] [ 0.04503292 -0.00493496 0.99897331 -1.97807218] [ 0. 0. 0. 1. ]] SLAMing on 2.191463509 meters 0.03114212098628718 Centerline is valid? [True, True] Translation: X:-1.23, Y:-1.43, Z:-2.00 [[ 0.31121625 -0.95014102 -0.01940307 -1.22628732] [ 0.94918375 0.31177956 -0.0429385 -1.42722457] [ 0.04684711 -0.00505392 0.99888929 -1.99834453] [ 0. 0. 0. 1. ]] SLAMing on 2.221463509 meters 0.037820178863605655 Centerline is valid? [True, True] Translation: X:-1.23, Y:-1.46, Z:-2.00 [[ 0.29481639 -0.95541127 -0.01651072 -1.22963085] [ 0.95472405 0.29523634 -0.03657179 -1.46226991] [ 0.03981566 -0.00498121 0.99919463 -1.99755933] [ 0. 0. 0. 1. ]] SLAMing on 2.251463509 meters 0.02828851427255156 Centerline is valid? [True, True] Translation: X:-1.26, Y:-1.48, Z:-1.98 [[ 0.30821861 -0.95113619 -0.01847272 -1.26395576] [ 0.95026686 0.30873231 -0.0409544 -1.48215107] [ 0.04465634 -0.0049311 0.99899024 -1.9750278 ] [ 0. 0. 0. 1. ]] SLAMing on 2.281463509 meters 0.02834901805636186 Centerline is valid? [True, True] Translation: X:-1.27, Y:-1.51, Z:-1.97 [[ 0.3042735 -0.95240459 -0.01852413 -1.27371776] [ 0.95153014 0.30479395 -0.04112217 -1.51437293] [ 0.04481099 -0.00511388 0.99898239 -1.96959839] [ 0. 0. 0. 1. ]] SLAMing on 2.311463509 meters 0.03128492220722605 Centerline is valid? [True, True] Translation: X:-1.27, Y:-1.55, Z:-1.96 [[ 0.30505571 -0.95214453 -0.019021 -1.2741257 ] [ 0.9512195 0.30560399 -0.04228072 -1.55067599] [ 0.04607025 -0.00519517 0.99892469 -1.96358871] [ 0. 0. 0. 1. ]] SLAMing on 2.341463509 meters 0.031224099222830367 Centerline is valid? [True, True] Translation: X:-1.28, Y:-1.58, Z:-1.96 [[ 0.30604571 -0.95182411 -0.01915414 -1.2844802 ] [ 0.95088311 0.30660098 -0.04262803 -1.58255333] [ 0.04644707 -0.00516722 0.99890739 -1.9630306 ] [ 0. 0. 0. 1. ]] SLAMing on 2.3714635090000002 meters 0.02962982729523228 Centerline is valid? [True, True] Translation: X:-1.30, Y:-1.61, Z:-1.96 [[ 0.31028228 -0.95045079 -0.01918857 -1.30267953] [ 0.94950136 0.3108356 -0.04275973 -1.6114799 ] [ 0.04660551 -0.00495199 0.9989011 -1.95834241] [ 0. 0. 0. 1. ]] SLAMing on 2.401463509 meters 0.02929115254245328 Centerline is valid? [True, True] Translation: X:-1.32, Y:-1.64, Z:-1.97 [[ 0.31334739 -0.94942766 -0.02001314 -1.31913491] [ 0.94839081 0.31394615 -0.04463945 -1.640161 ] [ 0.04866498 -0.00499262 0.99880268 -1.97370254] [ 0. 0. 0. 1. ]] SLAMing on 2.431463509 meters 0.030541424309980896 Centerline is valid? [True, True] Translation: X:-1.33, Y:-1.67, Z:-1.99 [[ 0.31469855 -0.9489777 -0.02015336 -1.32843445] [ 0.94792276 0.31530449 -0.04500577 -1.67205881] [ 0.04906391 -0.00494058 0.99878342 -1.98832415] [ 0. 0. 0. 1. ]] SLAMing on 2.461463509 meters 0.03707009414008156 Centerline is valid? [True, True] Translation: X:-1.33, Y:-1.71, Z:-1.98 [[ 0.29004649 -0.95689234 -0.01516867 -1.33453466] [ 0.95630286 0.29040529 -0.033906 -1.70616122] [ 0.03684945 -0.00467152 0.99930991 -1.97709319] [ 0. 0. 0. 1. ]] SLAMing on 2.491463509 meters 0.030998348399196435 Centerline is valid? [True, True] Translation: X:-1.36, Y:-1.73, Z:-1.97 [[ 0.31061853 -0.95037642 -0.01734354 -1.3618055 ] [ 0.94959417 0.311071 -0.03880387 -1.73046924] [ 0.04227336 -0.00441612 0.99909632 -1.9731735 ] [ 0. 0. 0. 1. ]] SLAMing on 2.521463509 meters 0.034636181614432895 Centerline is valid? [True, True] Translation: X:-1.38, Y:-1.76, Z:-1.99 [[ 0.30109172 -0.95347593 -0.01508062 -1.38012919] [ 0.95288691 0.30143987 -0.03377188 -1.75929933] [ 0.03674658 -0.00420169 0.99931578 -1.99072241] [ 0. 0. 0. 1. ]] SLAMing on 2.551463509 meters 0.0265604237358659 Centerline is valid? [True, True] Translation: X:-1.41, Y:-1.78, Z:-1.98 [[ 0.32861738 -0.94425308 -0.01991817 -1.40905072] [ 0.94320605 0.32919474 -0.04464482 -1.78273182] [ 0.04871297 -0.00411588 0.99880434 -1.98365708] [ 0. 0. 0. 1. ]] SLAMing on 2.581463509 meters 0.02013131091871093 Centerline is valid? [True, True] Translation: X:-1.44, Y:-1.81, Z:-1.97 [[ 0.3472561 -0.93754502 -0.02055551 -1.43701768] [ 0.9364161 0.34784889 -0.046109 -1.80534477] [ 0.05037947 -0.00323688 0.9987249 -1.96572241] [ 0. 0. 0. 1. ]] SLAMing on 2.611463509 meters 0.02445898965995972 Centerline is valid? [True, True] Translation: X:-1.46, Y:-1.83, Z:-1.98 [[ 0.33827467 -0.94087128 -0.0182068 -1.4577254 ] [ 0.93998816 0.33874838 -0.04088753 -1.83207004] [ 0.04463743 -0.00328296 0.99899786 -1.97760444] [ 0. 0. 0. 1. ]] SLAMing on 2.641463509 meters 0.024276617444484935 Centerline is valid? [True, True] Translation: X:-1.47, Y:-1.86, Z:-2.01 [[ 0.33888803 -0.94059323 -0.02095904 -1.46549991] [ 0.93941956 0.33951515 -0.04712067 -1.86373896] [ 0.05143729 -0.0037207 0.9986693 -2.00607543] [ 0. 0. 0. 1. ]] SLAMing on 2.671463509 meters 0.0218969050609712 Centerline is valid? [True, True] Translation: X:-1.50, Y:-1.88, Z:-1.95 [[ 0.3365343 -0.94155237 -0.01495992 -1.49823616] [ 0.94095409 0.33685546 -0.03367198 -1.88450246] [ 0.03674326 -0.00274483 0.99932097 -1.94864019] [ 0. 0. 0. 1. ]] SLAMing on 2.701463509 meters 0.01917609272414668 Centerline is valid? [True, True] Translation: X:-1.51, Y:-1.92, Z:-2.00 [[ 0.35499436 -0.93461875 -0.02160553 -1.50539462] [ 0.93335393 0.35563956 -0.0486923 -1.91725155] [ 0.05319252 -0.00288012 0.99858012 -1.99674083] [ 0. 0. 0. 1. ]] SLAMing on 2.731463509 meters 0.01808691421309543 Centerline is valid? [True, True] Translation: X:-1.52, Y:-1.95, Z:-1.97 [[ 0.35553749 -0.93447769 -0.01856178 -1.52311523] [ 0.93354255 0.35601331 -0.04186679 -1.94515966] [ 0.04573182 -0.002443 0.99895077 -1.97421072] [ 0. 0. 0. 1. ]] SLAMing on 2.761463509 meters 0.017524668517974813 Centerline is valid? [True, True] Translation: X:-1.56, Y:-1.97, Z:-1.97 [[ 0.35769303 -0.93366176 -0.01820487 -1.55625237] [ 0.93275913 0.35814876 -0.04110808 -1.96517961] [ 0.04490109 -0.00227668 0.99898884 -1.9734455 ] [ 0. 0. 0. 1. ]] SLAMing on 2.791463509 meters 0.01724521046634179 Centerline is valid? [True, True] Translation: X:-1.55, Y:-2.00, Z:-1.98 [[ 0.35694139 -0.93395815 -0.01774872 -1.55256993] [ 0.93309837 0.35737539 -0.04012809 -2.00281892] [ 0.04382092 -0.00223793 0.9990369 -1.98458187] [ 0. 0. 0. 1. ]] SLAMing on 2.821463509 meters 0.016753701804634473 Centerline is valid? [True, True] Translation: X:-1.58, Y:-2.03, Z:-1.97 [[ 0.36143115 -0.93221557 -0.01848392 -1.58008841] [ 0.93127934 0.3618974 -0.04182172 -2.02523383] [ 0.04567614 -0.00209802 0.9989541 -1.96730896] [ 0. 0. 0. 1. ]] SLAMing on 2.8514635090000002 meters 0.014029129080914362 Centerline is valid? [True, True] Translation: X:-1.60, Y:-2.05, Z:-1.97 [[ 3.70804397e-01 -9.28538865e-01 -1.78794549e-02 -1.59962539e+00] [ 9.27656476e-01 3.71231891e-01 -4.05011834e-02 -2.05139503e+00] [ 4.42443467e-02 -1.56797522e-03 9.99019509e-01 -1.96749122e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 2.881463509 meters 0.014029129080914362 Centerline is valid? [True, True] Translation: X:-1.61, Y:-2.08, Z:-1.97 [[ 3.70359445e-01 -9.28716801e-01 -1.78601449e-02 -1.61304804e+00] [ 9.27834209e-01 3.70786522e-01 -4.05097018e-02 -2.08096853e+00] [ 4.42443417e-02 -1.56810267e-03 9.99019509e-01 -1.96762987e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 2.911463509 meters 0.011721490456988247 Centerline is valid? [True, True] Translation: X:-1.62, Y:-2.12, Z:-1.98 [[ 3.88919752e-01 -9.21054911e-01 -1.99819207e-02 -1.61765346e+00] [ 9.19937456e-01 3.89432027e-01 -4.53626942e-02 -2.11504617e+00] [ 4.95631322e-02 -7.39669491e-04 9.98770719e-01 -1.97715753e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 2.941463509 meters 0.013006795463759038 Centerline is valid? [True, True] Translation: X:-1.64, Y:-2.14, Z:-1.97 [[ 3.78468348e-01 -9.25449993e-01 -1.74361776e-02 -1.64448543e+00] [ 9.24601758e-01 3.78868117e-01 -3.96300320e-02 -2.13968187e+00] [ 4.32816246e-02 -1.12280777e-03 9.99062280e-01 -1.97097613e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 2.971463509 meters 0.012176933881749029 Centerline is valid? [True, True] Translation: X:-1.66, Y:-2.17, Z:-1.97 [[ 3.89730913e-01 -9.20736259e-01 -1.88296902e-02 -1.65794138e+00] [ 9.19739765e-01 3.90185020e-01 -4.28300666e-02 -2.16896078e+00] [ 4.67822583e-02 -6.26213894e-04 9.98904914e-01 -1.97251964e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 3.001463509 meters 0.011593107970247879 Centerline is valid? [True, True] Translation: X:-1.67, Y:-2.20, Z:-1.98 [[ 3.93482181e-01 -9.19139523e-01 -1.88231323e-02 -1.66888955e+00] [ 9.18139583e-01 3.93931928e-01 -4.28642248e-02 -2.19891520e+00] [ 4.68132359e-02 -4.15954212e-04 9.98903573e-01 -1.98135976e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 3.031463509 meters 0.011648642299009922 Centerline is valid? [True, True] Translation: X:-1.68, Y:-2.23, Z:-1.97 [[ 4.01088607e-01 -9.15842894e-01 -1.89663497e-02 -1.68341111e+00] [ 9.14821312e-01 4.01536789e-01 -4.32454982e-02 -2.22869575e+00] [ 4.72217694e-02 -5.54423739e-06 9.98884430e-01 -1.97489209e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 3.061463509 meters 0.011711168050682437 Centerline is valid? [True, True] Translation: X:-1.69, Y:-2.26, Z:-1.99 [[ 3.96062103e-01 -9.18058037e-01 -1.74427947e-02 -1.69145551e+00] [ 9.17194100e-01 3.96445947e-01 -3.98195136e-02 -2.26030376e+00] [ 4.34717498e-02 -2.27428074e-04 9.99054631e-01 -1.98900882e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 3.091463509 meters 0.011841500710748316 Centerline is valid? [True, True] Translation: X:-1.70, Y:-2.29, Z:-1.99 [[ 3.96514927e-01 -9.17851414e-01 -1.80192738e-02 -1.70228514e+00] [ 9.16926938e-01 3.96924105e-01 -4.11855037e-02 -2.29082909e+00] [ 4.49544569e-02 -1.91690513e-04 9.98989019e-01 -1.98731978e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 3.1214635090000002 meters 0.011235397024132293 Centerline is valid? [True, True] Translation: X:-1.71, Y:-2.32, Z:-1.99 [[ 4.03547438e-01 -9.14812396e-01 -1.63629336e-02 -1.71308522e+00] [ 9.14046453e-01 4.03879015e-01 -3.74275781e-02 -2.32024398e+00] [ 4.08478579e-02 1.47321854e-04 9.99165367e-01 -1.99050401e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 3.151463509 meters 0.011746711887361599 Centerline is valid? [True, True] Translation: X:-1.72, Y:-2.35, Z:-2.00 [[ 4.03108795e-01 -9.14942882e-01 -1.95658278e-02 -1.72300392e+00] [ 9.13845065e-01 4.03583311e-01 -4.48074683e-02 -2.35160710e+00] [ 4.88927157e-02 1.82149322e-04 9.98804019e-01 -1.99684043e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 3.181463509 meters 0.012134513527917098 Centerline is valid? [True, True] Translation: X:-1.73, Y:-2.38, Z:-1.98 [[ 4.11377360e-01 -9.11293274e-01 -1.76984909e-02 -1.73133298e+00] [ 9.10389630e-01 4.11757492e-01 -4.05769453e-02 -2.38268827e+00] [ 4.42649836e-02 5.79914005e-04 9.99019657e-01 -1.98392895e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 3.211463509 meters 0.011396366689442976 Centerline is valid? [True, True] Translation: X:-1.75, Y:-2.41, Z:-2.02 [[ 3.99861532e-01 -9.16419045e-01 -1.69378097e-02 -1.74773191e+00] [ 9.15593835e-01 4.00220106e-01 -3.88818158e-02 -2.41111803e+00] [ 4.24108885e-02 3.91883457e-05 9.99100253e-01 -2.02195762e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 3.241463509 meters 0.011802080277101109 Centerline is valid? [True, True] Translation: X:-1.76, Y:-2.44, Z:-2.04 [[ 4.11357181e-01 -9.11345127e-01 -1.53404383e-02 -1.76237953e+00] [ 9.10663034e-01 4.11642776e-01 -3.52571135e-02 -2.43937351e+00] [ 3.84461792e-02 5.33296707e-04 9.99260530e-01 -2.04292805e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 3.271463509 meters 0.01230692500724161 Centerline is valid? [True, True] Translation: X:-1.77, Y:-2.47, Z:-2.06 [[ 4.12175602e-01 -9.10995392e-01 -1.40950293e-02 -1.77229964e+00] [ 9.10418060e-01 4.12416185e-01 -3.24321737e-02 -2.46940086e+00] [ 3.53585790e-02 5.35381536e-04 9.99374547e-01 -2.05675909e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 3.301463509 meters 0.012588772342839956 Centerline is valid? [True, True] Translation: X:-1.81, Y:-2.49, Z:-2.06 [[ 4.16733206e-01 -9.08905745e-01 -1.49593479e-02 -1.80518898e+00] [ 9.08252524e-01 4.17000896e-01 -3.44616610e-02 -2.48935632e+00] [ 3.75604631e-02 7.74452933e-04 9.99294057e-01 -2.05514891e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 3.331463509 meters 0.015410558510168685 Centerline is valid? [True, True] Translation: X:-1.82, Y:-2.52, Z:-2.06 [[ 4.33732683e-01 -9.00930804e-01 -1.41296031e-02 -1.82127495e+00] [ 9.00342659e-01 4.33960483e-01 -3.25790808e-02 -2.51841377e+00] [ 3.54831868e-02 1.40912773e-03 9.99369280e-01 -2.06142365e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 3.361463509 meters 0.014170047086355053 Centerline is valid? [True, True] Translation: X:-1.84, Y:-2.55, Z:-2.06 [[ 4.23295856e-01 -9.05902651e-01 -1.26887571e-02 -1.83824106e+00] [ 9.05429462e-01 4.23485016e-01 -2.92904563e-02 -2.54717179e+00] [ 3.19078005e-02 9.09754267e-04 9.99490402e-01 -2.05611835e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 3.391463509 meters 0.01580672889272212 Centerline is valid? [True, True] Translation: X:-1.86, Y:-2.57, Z:-2.05 [[ 4.24881334e-01 -9.05136987e-01 -1.42438133e-02 -1.85930557e+00] [ 9.04538913e-01 4.25118595e-01 -3.29170982e-02 -2.57371369e+00] [ 3.58497930e-02 1.10177719e-03 9.99356582e-01 -2.05335273e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 3.421463509 meters 0.017359863349837922 Centerline is valid? [True, True] Translation: X:-1.87, Y:-2.60, Z:-2.06 [[ 4.40204760e-01 -8.97803484e-01 -1.29873920e-02 -1.87351665e+00] [ 8.97301913e-01 4.40393492e-01 -3.00474390e-02 -2.60291356e+00] [ 3.26962584e-02 1.57341400e-03 9.99464096e-01 -2.06024992e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 3.451463509 meters 0.017417341725023426 Centerline is valid? [True, True] Translation: X:-1.89, Y:-2.63, Z:-2.07 [[ 4.38214661e-01 -8.98787020e-01 -1.22394364e-02 -1.88808083e+00] [ 8.98340923e-01 4.38383227e-01 -2.83501685e-02 -2.63244004e+00] [ 3.08463271e-02 1.42827291e-03 9.99523118e-01 -2.07010036e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 3.481463509 meters 0.019885739919342456 Centerline is valid? [True, True] Translation: X:-1.90, Y:-2.66, Z:-2.07 [[ 4.49865232e-01 -8.92986166e-01 -1.40349849e-02 -1.90058671e+00] [ 8.92395747e-01 4.50079157e-01 -3.25358769e-02 -2.66289597e+00] [ 3.53709422e-02 2.11199895e-03 9.99372021e-01 -2.07156347e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 3.511463509 meters 0.01810302680997334 Centerline is valid? [True, True] Translation: X:-1.91, Y:-2.69, Z:-2.10 [[ 4.37801482e-01 -8.98967042e-01 -1.37156726e-02 -1.91318429e+00] [ 8.98404678e-01 4.38013299e-01 -3.18336994e-02 -2.69367231e+00] [ 3.46250936e-02 1.61461640e-03 9.99399067e-01 -2.09874747e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 3.541463509 meters 0.01667775192624788 Centerline is valid? [True, True] Translation: X:-1.92, Y:-2.73, Z:-2.07 [[ 4.33248539e-01 -9.01201035e-01 -1.15064099e-02 -1.91841130e+00] [ 9.00805209e-01 4.33399597e-01 -2.67350757e-02 -2.72684255e+00] [ 2.90805513e-02 1.21789847e-03 9.99576329e-01 -2.06957332e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 3.571463509 meters 0.014923456079735201 Centerline is valid? [True, True] Translation: X:-1.92, Y:-2.76, Z:-2.10 [[ 4.34392934e-01 -9.00614155e-01 -1.40329211e-02 -1.91556260e+00] [ 9.00023735e-01 4.34616777e-01 -3.26425073e-02 -2.76183957e+00] [ 3.54972471e-02 1.54971245e-03 9.99368573e-01 -2.09754673e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 3.601463509 meters 0.014565968457599627 Centerline is valid? [True, True] Translation: X:-1.92, Y:-2.79, Z:-2.11 [[ 4.33442598e-01 -9.01095773e-01 -1.24065368e-02 -1.92180009e+00] [ 9.00633455e-01 4.33618019e-01 -2.88927975e-02 -2.79386756e+00] [ 3.14148756e-02 1.34962717e-03 9.99505520e-01 -2.10711652e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 3.631463509 meters 0.01224519452899688 Centerline is valid? [True, True] Translation: X:-1.93, Y:-2.83, Z:-2.11 [[ 4.14956705e-01 -9.09766953e-01 -1.16200096e-02 -1.92706861e+00] [ 9.09363567e-01 4.15118817e-01 -2.70974312e-02 -2.82740900e+00] [ 2.94760320e-02 6.77447343e-04 9.99565258e-01 -2.11366737e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 3.661463509 meters 0.013272057536906945 Centerline is valid? [True, True] Translation: X:-1.94, Y:-2.86, Z:-2.11 [[ 4.19921363e-01 -9.07498443e-01 -1.06124868e-02 -1.94425133e+00] [ 9.07160421e-01 4.20054724e-01 -2.47790028e-02 -2.85540688e+00] [ 2.69447317e-02 7.78004632e-04 9.99636622e-01 -2.11085751e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 3.691463509 meters 0.012895484312840584 Centerline is valid? [True, True] Translation: X:-1.95, Y:-2.89, Z:-2.12 [[ 4.19122412e-01 -9.07839686e-01 -1.27870278e-02 -1.95018405e+00] [ 9.07348263e-01 4.19316415e-01 -2.98810072e-02 -2.88680147e+00] [ 3.24889748e-02 9.21512343e-04 9.99471669e-01 -2.12407449e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 3.721463509 meters 0.012421732356791629 Centerline is valid? [True, True] Translation: X:-1.97, Y:-2.91, Z:-2.12 [[ 4.19403253e-01 -9.07747745e-01 -9.74387714e-03 -1.96742042e+00] [ 9.07461746e-01 4.19515811e-01 -2.27961177e-02 -2.91401263e+00] [ 2.47808349e-02 7.18570161e-04 9.99692650e-01 -2.11897702e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 3.751463509 meters 0.01347496566325187 Centerline is valid? [True, True] Translation: X:-1.97, Y:-2.95, Z:-2.13 [[ 4.20815193e-01 -9.07066950e-01 -1.20050626e-02 -1.97400772e+00] [ 9.06631415e-01 4.20985328e-01 -2.81217276e-02 -2.94600538e+00] [ 3.05622449e-02 9.49883373e-04 9.99532414e-01 -2.12915318e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 3.781463509 meters 0.01316313821296571 Centerline is valid? [True, True] Translation: X:-1.99, Y:-2.97, Z:-2.13 [[ 4.24737399e-01 -9.05241300e-01 -1.16760731e-02 -1.99145773e+00] [ 9.04827695e-01 4.24896521e-01 -2.73822600e-02 -2.97260172e+00] [ 2.97486755e-02 1.06543563e-03 9.99556842e-01 -2.13457971e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 3.811463509 meters 0.013691610675510033 Centerline is valid? [True, True] Translation: X:-2.00, Y:-3.00, Z:-2.13 [[ 4.26071022e-01 -9.04628242e-01 -1.05464127e-02 -1.99959528e+00] [ 9.04289727e-01 4.26200319e-01 -2.47664427e-02 -3.00446179e+00] [ 2.68993080e-02 1.01525087e-03 9.99637633e-01 -2.13002291e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 3.841463509 meters 0.013329367417871824 Centerline is valid? [True, True] Translation: X:-2.02, Y:-3.03, Z:-2.14 [[ 4.13812540e-01 -9.10311414e-01 -9.60783842e-03 -2.02224795e+00] [ 9.10031226e-01 4.13923619e-01 -2.25921410e-02 -3.03059817e+00] [ 2.45427951e-02 6.05478294e-04 9.99698597e-01 -2.14424286e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 3.871463509 meters 0.012523507300909467 Centerline is valid? [True, True] Translation: X:-2.02, Y:-3.06, Z:-2.15 [[ 4.18785003e-01 -9.08034512e-01 -9.61491413e-03 -2.02392560e+00] [ 9.07752642e-01 4.18894689e-01 -2.26358201e-02 -3.06421136e+00] [ 2.45817423e-02 7.51578287e-04 9.99697541e-01 -2.15394077e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 3.901463509 meters 0.012795663938952439 Centerline is valid? [True, True] Translation: X:-2.04, Y:-3.09, Z:-2.14 [[ 4.14748692e-01 -9.09872606e-01 -1.07407284e-02 -2.03993839e+00] [ 9.09520544e-01 4.14887098e-01 -2.53194846e-02 -3.09297925e+00] [ 2.74936951e-02 7.32309951e-04 9.99621709e-01 -2.14453930e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 3.931463509 meters 0.012243474302011961 Centerline is valid? [True, True] Translation: X:-2.04, Y:-3.13, Z:-2.15 [[ 4.16517720e-01 -9.09073947e-01 -9.87662900e-03 -2.04148239e+00] [ 9.08775314e-01 4.16634157e-01 -2.33111077e-02 -3.12666939e+00] [ 2.53064617e-02 7.33852820e-04 9.99679471e-01 -2.14663178e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 3.961463509 meters 0.012378873733086052 Centerline is valid? [True, True] Translation: X:-2.06, Y:-3.16, Z:-2.13 [[ 4.04146696e-01 -9.14623887e-01 -1.13399296e-02 -2.05562170e+00] [ 9.14231220e-01 4.04305491e-01 -2.68019769e-02 -3.15653742e+00] [ 2.90985241e-02 4.64612740e-04 9.99576440e-01 -2.13127539e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 3.991463509 meters 0.011654721117361039 Centerline is valid? [True, True] Translation: X:-2.06, Y:-3.19, Z:-2.14 [[ 3.97895399e-01 -9.17381612e-01 -9.49893936e-03 -2.05933780e+00] [ 9.17106412e-01 3.98008701e-01 -2.24700676e-02 -3.19011049e+00] [ 2.43942874e-02 2.29198329e-04 9.99702389e-01 -2.13917433e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 4.021463508999999 meters 0.01139925256444122 Centerline is valid? [True, True] Translation: X:-2.07, Y:-3.22, Z:-2.13 [[ 3.94514685e-01 -9.18840479e-01 -9.50464017e-03 -2.06839865e+00] [ 9.18564691e-01 3.94629132e-01 -2.25112329e-02 -3.22194414e+00] [ 2.44350399e-02 1.50385092e-04 9.99701409e-01 -2.13376174e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 4.0514635089999995 meters 0.011593663804072644 Centerline is valid? [True, True] Translation: X:-2.07, Y:-3.26, Z:-2.13 [[ 3.79478185e-01 -9.25153843e-01 -9.30982620e-03 -2.07236795e+00] [ 9.24890383e-01 3.79592297e-01 -2.20786538e-02 -3.25644067e+00] [ 2.39600897e-02 -2.32201257e-04 9.99712889e-01 -2.13111598e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 4.081463509 meters 0.011453819100617704 Centerline is valid? [True, True] Translation: X:-2.09, Y:-3.28, Z:-2.13 [[ 3.86908328e-01 -9.22085943e-01 -7.71100387e-03 -2.08618009e+00] [ 9.21904293e-01 3.86985159e-01 -1.83019240e-02 -3.28490442e+00] [ 1.98599909e-02 -2.76407577e-05 9.99802771e-01 -2.13025795e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 4.111463508999999 meters 0.011309090194097739 Centerline is valid? [True, True] Translation: X:-2.10, Y:-3.31, Z:-2.14 [[ 3.80892665e-01 -9.24569488e-01 -9.59376043e-03 -2.09874691e+00] [ 9.24288395e-01 3.81013423e-01 -2.27976958e-02 -3.31478050e+00] [ 2.47334054e-02 -1.83926319e-04 9.99694066e-01 -2.13504033e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 4.141463508999999 meters 0.011371029460443391 Centerline is valid? [True, True] Translation: X:-2.12, Y:-3.34, Z:-2.14 [[ 3.86166060e-01 -9.22387441e-01 -8.78539762e-03 -2.11891439e+00] [ 9.22150577e-01 3.86265981e-01 -2.09022945e-02 -3.34126887e+00] [ 2.26735141e-02 -2.97027826e-05 9.99742922e-01 -2.13932694e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 4.171463509 meters 0.011491497456761424 Centerline is valid? [True, True] Translation: X:-2.13, Y:-3.37, Z:-2.13 [[ 3.86159296e-01 -9.22403767e-01 -7.23103498e-03 -2.13239111e+00] [ 9.22242928e-01 3.86226993e-01 -1.72247331e-02 -3.37136633e+00] [ 1.86809796e-02 -1.72800567e-05 9.99825495e-01 -2.12923821e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 4.201463509 meters 0.01154162466628877 Centerline is valid? [True, True] Translation: X:-2.16, Y:-3.40, Z:-2.15 [[ 3.90078329e-01 -9.20725731e-01 -1.01501142e-02 -2.15548320e+00] [ 9.20407388e-01 3.90210350e-01 -2.42099622e-02 -3.39710060e+00] [ 2.62514148e-02 1.01541480e-04 9.99655367e-01 -2.14559065e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 4.231463508999999 meters 0.011511610640486579 Centerline is valid? [True, True] Translation: X:-2.16, Y:-3.43, Z:-2.15 [[ 3.87672753e-01 -9.21773192e-01 -6.63469226e-03 -2.16472717e+00] [ 9.21637133e-01 3.87729522e-01 -1.58370777e-02 -3.42739986e+00] [ 1.71706597e-02 2.48247666e-05 9.99852573e-01 -2.14680319e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 4.2614635089999995 meters 0.011471377709607447 Centerline is valid? [True, True] Translation: X:-2.17, Y:-3.46, Z:-2.15 [[ 3.78752532e-01 -9.25460812e-01 -8.29488243e-03 -2.16886333e+00] [ 9.25248480e-01 3.78843315e-01 -1.98240447e-02 -3.46116996e+00] [ 2.14888373e-02 -1.66420226e-04 9.99769074e-01 -2.15301615e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 4.291463509 meters 0.011469775560094455 Centerline is valid? [True, True] Translation: X:-2.18, Y:-3.49, Z:-2.15 [[ 3.77591263e-01 -9.25935412e-01 -8.27350161e-03 -2.17722453e+00] [ 9.25723737e-01 3.77681849e-01 -1.97985543e-02 -3.49348704e+00] [ 2.14569339e-02 -1.83215718e-04 9.99769757e-01 -2.15293658e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 4.321463509 meters 0.012382687437375505 Centerline is valid? [True, True] Translation: X:-2.18, Y:-3.53, Z:-2.15 [[ 3.60328626e-01 -9.32787756e-01 -8.38348138e-03 -2.17633408e+00] [ 9.32571672e-01 3.60425671e-01 -2.00851445e-02 -3.52810852e+00] [ 2.17567988e-02 -5.80944721e-04 9.99763124e-01 -2.14624808e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 4.351463508999999 meters 0.012973688855175547 Centerline is valid? [True, True] Translation: X:-2.18, Y:-3.56, Z:-2.13 [[ 3.53166127e-01 -9.35534779e-01 -6.95437139e-03 -2.18438302e+00] [ 9.35386361e-01 3.53234054e-01 -1.66750798e-02 -3.56043219e+00] [ 1.80566379e-02 -6.15950816e-04 9.99836776e-01 -2.13325718e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 4.381463509 meters 0.013966652309914984 Centerline is valid? [True, True] Translation: X:-2.19, Y:-3.59, Z:-2.13 [[ 3.43823746e-01 -9.38998632e-01 -8.17313782e-03 -2.18647839e+00] [ 9.38794072e-01 3.43919627e-01 -1.96209084e-02 -3.59468647e+00] [ 2.12349087e-02 -9.26759103e-04 9.99774084e-01 -2.13069260e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 4.411463509 meters 0.015229028120403292 Centerline is valid? [True, True] Translation: X:-2.19, Y:-3.63, Z:-2.12 [[ 3.30866740e-01 -9.43653736e-01 -6.69532815e-03 -2.18631507e+00] [ 9.43517108e-01 3.30932982e-01 -1.60881673e-02 -3.63051649e+00] [ 1.73973641e-02 -9.94117183e-04 9.99848160e-01 -2.12160157e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 4.441463508999999 meters 0.019549292442139026 Centerline is valid? [True, True] Translation: X:-2.18, Y:-3.67, Z:-2.12 [[ 3.15859643e-01 -9.48788283e-01 -5.78613206e-03 -2.18022041e+00] [ 9.48686795e-01 3.15910747e-01 -1.39199851e-02 -3.66874484e+00] [ 1.50350201e-02 -1.09246555e-03 9.99886371e-01 -2.12024633e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 4.4714635089999994 meters 0.017193404438764395 Centerline is valid? [True, True] Translation: X:-2.19, Y:-3.70, Z:-2.15 [[ 3.13687769e-01 -9.49494105e-01 -7.80566334e-03 -2.18821856e+00] [ 9.49309077e-01 3.13781231e-01 -1.88046529e-02 -3.69992600e+00] [ 2.03041777e-02 -1.51119746e-03 9.99792707e-01 -2.14722527e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 4.501463509 meters 0.01783823352048072 Centerline is valid? [True, True] Translation: X:-2.19, Y:-3.73, Z:-2.14 [[ 3.03451351e-01 -9.52828738e-01 -5.88836720e-03 -2.19375795e+00] [ 9.52723759e-01 3.03505693e-01 -1.42032776e-02 -3.73300140e+00] [ 1.53204440e-02 -1.29998356e-03 9.99881790e-01 -2.14364583e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 4.531463509 meters 0.019867429695663057 Centerline is valid? [True, True] Translation: X:-2.20, Y:-3.77, Z:-2.11 [[ 2.98685824e-01 -9.54330913e-01 -6.26792012e-03 -2.20202485e+00] [ 9.54211921e-01 2.98748022e-01 -1.51403100e-02 -3.76560430e+00] [ 1.63213946e-02 -1.45872812e-03 9.99865733e-01 -2.11215246e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 4.561463508999999 meters 0.021243018588592087 Centerline is valid? [True, True] Translation: X:-2.20, Y:-3.80, Z:-2.13 [[ 2.87851782e-01 -9.57658078e-01 -5.68836520e-03 -2.20351478e+00] [ 9.57560400e-01 2.87904144e-01 -1.37580726e-02 -3.79953769e+00] [ 1.48132333e-02 -1.48666752e-03 9.99889173e-01 -2.12538537e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 4.5914635089999996 meters 0.020584573744003885 Centerline is valid? [True, True] Translation: X:-2.22, Y:-3.83, Z:-2.12 [[ 2.83514871e-01 -9.58951740e-01 -5.55683165e-03 -2.22125824e+00] [ 9.58858496e-01 2.83565288e-01 -1.34578242e-02 -3.82657854e+00] [ 1.44811285e-02 -1.51272194e-03 9.99893999e-01 -2.11776373e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 4.621463509 meters 0.025614611551401698 Centerline is valid? [True, True] Translation: X:-2.21, Y:-3.87, Z:-2.10 [[ 2.75437503e-01 -9.61311042e-01 -3.90667175e-03 -2.21311707e+00] [ 9.61265072e-01 2.75462820e-01 -9.47077827e-03 -3.86544315e+00] [ 1.01805065e-02 -1.14673959e-03 9.99947520e-01 -2.10364960e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 4.651463508999999 meters 0.02315439271977877 Centerline is valid? [True, True] Translation: X:-2.23, Y:-3.89, Z:-2.12 [[ 2.75315712e-01 -9.61337979e-01 -5.52704629e-03 -2.23045732e+00] [ 9.61245706e-01 2.75366426e-01 -1.34172972e-02 -3.89402141e+00] [ 1.44205203e-02 -1.61885680e-03 9.99894708e-01 -2.11526887e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 4.681463508999999 meters 0.022324442155807093 Centerline is valid? [True, True] Translation: X:-2.24, Y:-3.93, Z:-2.11 [[ 2.72690499e-01 -9.62095421e-01 -3.50613514e-03 -2.23741353e+00] [ 9.62058258e-01 2.72711019e-01 -8.52103585e-03 -3.92712387e+00] [ 9.15421126e-03 -1.04950074e-03 9.99957549e-01 -2.10912110e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 4.711463509 meters 0.02651570985852849 Centerline is valid? [True, True] Translation: X:-2.25, Y:-3.96, Z:-2.10 [[ 2.65188352e-01 -9.64176840e-01 -6.17734806e-03 -2.24878932e+00] [ 9.64061631e-01 2.65252986e-01 -1.50341199e-02 -3.95922658e+00] [ 1.61341102e-02 -1.96847077e-03 9.99867899e-01 -2.09572440e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 4.741463509 meters 0.020966407133808925 Centerline is valid? [True, True] Translation: X:-2.28, Y:-3.98, Z:-2.07 [[ 2.76115843e-01 -9.61116424e-01 -3.90645426e-03 -2.27705633e+00] [ 9.61069984e-01 2.76141175e-01 -9.51509230e-03 -3.98315911e+00] [ 1.02238444e-02 -1.12710820e-03 9.99947100e-01 -2.06910219e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 4.771463508999999 meters 0.020966407133808925 Centerline is valid? [True, True] Translation: X:-2.29, Y:-4.01, Z:-2.07 [[ 2.75609552e-01 -9.61261747e-01 -3.90223759e-03 -2.29011951e+00] [ 9.61215298e-01 2.75634868e-01 -9.51682190e-03 -4.01387484e+00] [ 1.02237496e-02 -1.12796345e-03 9.99947100e-01 -2.06924478e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 4.8014635089999995 meters 0.025191807649809283 Centerline is valid? [True, True] Translation: X:-2.29, Y:-4.05, Z:-2.08 [[ 2.63922127e-01 -9.64538333e-01 -3.30383313e-03 -2.29375633e+00] [ 9.64505166e-01 2.63940689e-01 -8.06835429e-03 -4.04872949e+00] [ 8.65425298e-03 -1.05714689e-03 9.99961992e-01 -2.08096815e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 4.831463509 meters 0.026212103537280165 Centerline is valid? [True, True] Translation: X:-2.31, Y:-4.08, Z:-2.08 [[ 2.64543867e-01 -9.64362184e-01 -4.70328780e-03 -2.30524710e+00] [ 9.64294723e-01 2.64581466e-01 -1.15036531e-02 -4.07922549e+00] [ 1.23380908e-02 -1.49213472e-03 9.99922770e-01 -2.07760844e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 4.861463508999999 meters 0.026505375194856167 Centerline is valid? [True, True] Translation: X:-2.31, Y:-4.11, Z:-2.07 [[ 2.58518641e-01 -9.65996352e-01 -4.37727427e-03 -2.30575930e+00] [ 9.65937968e-01 2.58551592e-01 -1.07198726e-02 -4.11459840e+00] [ 1.14871091e-02 -1.45688851e-03 9.99932960e-01 -2.06683741e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 4.891463508999999 meters 0.028958490320364978 Centerline is valid? [True, True] Translation: X:-2.30, Y:-4.15, Z:-2.07 [[ 2.58174267e-01 -9.66062753e-01 -8.29485749e-03 -2.29640951e+00] [ 9.65852444e-01 2.58292749e-01 -2.03448282e-02 -4.15351515e+00] [ 2.17968823e-02 -2.75909728e-03 9.99758613e-01 -2.07160627e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 4.921463509 meters 0.026229023993322238 Centerline is valid? [True, True] Translation: X:-2.32, Y:-4.18, Z:-2.05 [[ 2.54974962e-01 -9.66941958e-01 -3.31945531e-03 -2.31885406e+00] [ 9.66908285e-01 2.54994056e-01 -8.14854798e-03 -4.17900495e+00] [ 8.72561431e-03 -1.13193313e-03 9.99961290e-01 -2.05196018e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 4.951463509 meters 0.0309307345960835 Centerline is valid? [True, True] Translation: X:-2.30, Y:-4.22, Z:-2.04 [[ 2.57229941e-01 -9.66282176e-01 -1.14679672e-02 -2.30405106e+00] [ 9.65878090e-01 2.57457079e-01 -2.82022536e-02 -4.22141557e+00] [ 3.02038443e-02 -3.82219422e-03 9.99536452e-01 -2.04246929e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 4.981463508999999 meters 0.02456028262971684 Centerline is valid? [True, True] Translation: X:-2.34, Y:-4.24, Z:-2.03 [[ 2.45570543e-01 -9.69366767e-01 -4.81461176e-03 -2.34262029e+00] [ 9.69295908e-01 2.45611455e-01 -1.18514417e-02 -4.24040606e+00] [ 1.26709175e-02 -1.75641851e-03 9.99918178e-01 -2.02907346e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 5.0114635089999995 meters 0.02700553444609087 Centerline is valid? [True, True] Translation: X:-2.34, Y:-4.28, Z:-2.05 [[ 2.35805693e-01 -9.71778957e-01 -6.42914882e-03 -2.34322392e+00] [ 9.71652947e-01 2.35879971e-01 -1.58489634e-02 -4.27644921e+00] [ 1.69181966e-02 -2.50962559e-03 9.99853728e-01 -2.04943665e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 5.041463509 meters 0.02940739639952775 Centerline is valid? [True, True] Translation: X:-2.33, Y:-4.32, Z:-2.05 [[ 2.37617699e-01 -9.71338822e-01 -6.22273700e-03 -2.32631647e+00] [ 9.71220261e-01 2.37687120e-01 -1.53635341e-02 -4.31985152e+00] [ 1.64022615e-02 -2.39300063e-03 9.99862610e-01 -2.04939138e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 5.071463508999999 meters 0.029479744417511534 Centerline is valid? [True, True] Translation: X:-2.34, Y:-4.35, Z:-2.04 [[ 2.31371425e-01 -9.72841867e-01 -6.77983035e-03 -2.34344341e+00] [ 9.72701235e-01 2.31454799e-01 -1.67625779e-02 -4.34847138e+00] [ 1.78765618e-02 -2.71636782e-03 9.99836512e-01 -2.03508061e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 5.101463508999999 meters 0.034068026855812 Centerline is valid? [True, True] Translation: X:-2.32, Y:-4.39, Z:-2.04 [[ 2.26889971e-01 -9.73871933e-01 -9.71594987e-03 -2.32432369e+00] [ 9.73582981e-01 2.27062657e-01 -2.40567851e-02 -4.39215462e+00] [ 2.56343572e-02 -4.00104019e-03 9.99663379e-01 -2.03952185e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 5.131463509 meters 0.030653254140104072 Centerline is valid? [True, True] Translation: X:-2.36, Y:-4.42, Z:-2.02 [[ 2.22389892e-01 -9.74939054e-01 -6.04789232e-03 -2.35603286e+00] [ 9.74827139e-01 2.22457366e-01 -1.49923295e-02 -4.41502617e+00] [ 1.59620058e-02 -2.56150701e-03 9.99869318e-01 -2.02084611e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 5.161463509 meters 0.029315871704701995 Centerline is valid? [True, True] Translation: X:-2.37, Y:-4.45, Z:-2.02 [[ 2.27760827e-01 -9.73693188e-01 -6.82505909e-03 -2.36748008e+00] [ 9.73549829e-01 2.27846024e-01 -1.69387320e-02 -4.44727089e+00] [ 1.80481905e-02 -2.78655551e-03 9.99833235e-01 -2.01504723e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 5.191463508999999 meters 0.02853469139698805 Centerline is valid? [True, True] Translation: X:-2.38, Y:-4.48, Z:-2.05 [[ 2.33288434e-01 -9.72354972e-01 -1.01150694e-02 -2.37717648e+00] [ 9.72038061e-01 2.33473907e-01 -2.51384665e-02 -4.47813376e+00] [ 2.68051177e-02 -3.96771899e-03 9.99632804e-01 -2.05382207e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 5.2214635089999994 meters 0.029860127242131586 Centerline is valid? [True, True] Translation: X:-2.38, Y:-4.51, Z:-2.05 [[ 2.29012946e-01 -9.73373284e-01 -9.87523669e-03 -2.38138044e+00] [ 9.73071104e-01 2.29191192e-01 -2.45768906e-02 -4.51265353e+00] [ 2.61858060e-02 -3.98088133e-03 9.99649167e-01 -2.05148830e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 5.251463509 meters 0.02852560138858051 Centerline is valid? [True, True] Translation: X:-2.40, Y:-4.54, Z:-2.03 [[ 2.32291562e-01 -9.72605967e-01 -8.84661432e-03 -2.40095384e+00] [ 9.72362307e-01 2.32433894e-01 -2.20460797e-02 -4.54063871e+00] [ 2.34984017e-02 -3.48099601e-03 9.99717814e-01 -2.03158960e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 5.281463508999999 meters 0.026014478473029345 Centerline is valid? [True, True] Translation: X:-2.42, Y:-4.57, Z:-2.04 [[ 2.35190936e-01 -9.71896490e-01 -1.01211075e-02 -2.41644414e+00] [ 9.71576059e-01 2.35376413e-01 -2.52568058e-02 -4.56964687e+00] [ 2.69292709e-02 -3.89325392e-03 9.99629760e-01 -2.03699617e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 5.311463508999999 meters 0.02778683793008634 Centerline is valid? [True, True] Translation: X:-2.43, Y:-4.60, Z:-2.01 [[ 2.29623935e-01 -9.73222517e-01 -1.05252256e-02 -2.43365821e+00] [ 9.72876081e-01 2.29826657e-01 -2.63028335e-02 -4.59885784e+00] [ 2.80174873e-02 -4.19998011e-03 9.99598610e-01 -2.00845175e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 5.3414635089999996 meters 0.028149554744740096 Centerline is valid? [True, True] Translation: X:-2.43, Y:-4.64, Z:-2.04 [[ 2.35123851e-01 -9.71915564e-01 -9.84431910e-03 -2.42952040e+00] [ 9.71610785e-01 2.35299581e-01 -2.46290233e-02 -4.63618671e+00] [ 2.62536953e-02 -3.77397581e-03 9.99648188e-01 -2.04458956e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 5.371463509 meters SLAMing on 5.401463508999999 meters 0.026298849654873845 Centerline is valid? [True, True] Translation: X:-2.45, Y:-4.66, Z:-2.02 [[ 2.44119140e-01 -9.69662096e-01 -1.26990140e-02 -2.45298673e+00] [ 9.69150664e-01 2.44407042e-01 -3.18149046e-02 -4.66346691e+00] [ 3.39534355e-02 -4.54063072e-03 9.99413101e-01 -2.02148399e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 5.431463508999999 meters SLAMing on 5.461463509 meters 0.025552809356419376 Centerline is valid? [True, True] Translation: X:-2.46, Y:-4.70, Z:-2.08 [[ 0.2450851 -0.96939412 -0.01443396 -2.45709901] [ 0.96873105 0.24545663 -0.03621056 -4.69686401] [ 0.03864521 -0.00510795 0.99923994 -2.07856085] [ 0. 0. 0. 1. ]] SLAMing on 5.491463509 meters 0.02529943337728774 Centerline is valid? [True, True] Translation: X:-2.48, Y:-4.72, Z:-2.04 [[ 2.53092094e-01 -9.67342523e-01 -1.38864909e-02 -2.48175891e+00] [ 9.66724632e-01 2.53431056e-01 -3.48738505e-02 -4.72302865e+00] [ 3.72542266e-02 -4.59811699e-03 9.99295242e-01 -2.03683691e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 5.521463508999999 meters 0.02673401470695344 Centerline is valid? [True, True] Translation: X:-2.49, Y:-4.75, Z:-2.06 [[ 2.47275938e-01 -9.68854044e-01 -1.32835320e-02 -2.49389673e+00] [ 9.68288866e-01 2.47589714e-01 -3.34066630e-02 -4.75478711e+00] [ 3.56550464e-02 -4.60163219e-03 9.99353562e-01 -2.06156395e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 5.5514635089999995 meters 0.024585300178801235 Centerline is valid? [True, True] Translation: X:-2.50, Y:-4.79, Z:-2.06 [[ 2.60809330e-01 -9.65267078e-01 -1.54260237e-02 -2.50345856e+00] [ 9.64497145e-01 2.61221963e-01 -3.88373918e-02 -4.78733746e+00] [ 4.15180719e-02 -4.74920168e-03 9.99126466e-01 -2.06353476e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 5.581463509 meters 0.024265416324227455 Centerline is valid? [True, True] Translation: X:-2.52, Y:-4.82, Z:-2.08 [[ 0.26218422 -0.96487808 -0.01642364 -2.51824598] [ 0.96400221 0.26265096 -0.04140314 -4.81720368] [ 0.04426267 -0.00497718 0.99900753 -2.07879432] [ 0. 0. 0. 1. ]] SLAMing on 5.611463508999999 meters 0.02419642383806208 Centerline is valid? [True, True] Translation: X:-2.53, Y:-4.85, Z:-2.08 [[ 2.62461849e-01 -9.64812674e-01 -1.58203017e-02 -2.52573878e+00] [ 9.63997530e-01 2.62894967e-01 -3.99374399e-02 -4.85046817e+00] [ 4.26912258e-02 -4.76867746e-03 9.99076933e-01 -2.07547603e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 5.641463508999999 meters SLAMing on 5.671463509 meters SLAMing on 5.701463509 meters SLAMing on 5.731463508999999 meters SLAMing on 5.7614635089999995 meters SLAMing on 5.791463509 meters SLAMing on 5.821463508999999 meters SLAMing on 5.851463508999999 meters SLAMing on 5.881463509 meters SLAMing on 5.911463509 meters SLAMing on 5.941463508999999 meters SLAMing on 5.9714635089999994 meters SLAMing on 6.001463509 meters SLAMing on 6.031463508999999 meters SLAMing on 6.061463508999999 meters SLAMing on 6.0914635089999996 meters SLAMing on 6.121463509 meters 0.013583396784993257 Centerline is valid? [True, True] Translation: X:-2.60, Y:-4.86, Z:-2.13 [[ 3.37551167e-01 -9.40967827e-01 -2.52736884e-02 -2.60359800e+00] [ 9.38800061e-01 3.38489075e-01 -6.38716770e-02 -4.85567779e+00] [ 6.86560605e-02 -2.16698109e-03 9.97638035e-01 -2.13491394e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 6.151463508999999 meters SLAMing on 6.181463508999999 meters 0.01518186106466872 Centerline is valid? [True, True] Translation: X:-2.61, Y:-4.89, Z:-2.15 [[ 3.25378350e-01 -9.45309026e-01 -2.27985794e-02 -2.60675277e+00] [ 9.43551158e-01 3.26164577e-01 -5.76877843e-02 -4.88924183e+00] [ 6.19688722e-02 -2.74126993e-03 9.98074318e-01 -2.14518626e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 6.211463509 meters 0.015588176845135866 Centerline is valid? [True, True] Translation: X:-2.62, Y:-4.92, Z:-2.15 [[ 3.23550094e-01 -9.45908766e-01 -2.39153309e-02 -2.61804485e+00] [ 9.43970474e-01 3.24419157e-01 -6.05966524e-02 -4.92088890e+00] [ 6.50774962e-02 -2.96931365e-03 9.97875795e-01 -2.15420467e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 6.241463509 meters 0.016439650112278974 Centerline is valid? [True, True] Translation: X:-2.62, Y:-4.96, Z:-2.16 [[ 3.17831763e-01 -9.47889767e-01 -2.20897989e-02 -2.62133514e+00] [ 9.46236161e-01 3.18583516e-01 -5.60506089e-02 -4.95589141e+00] [ 6.01672444e-02 -3.08750267e-03 9.98183535e-01 -2.15769499e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 6.271463508999999 meters SLAMing on 6.3014635089999995 meters SLAMing on 6.331463509 meters 0.01879437687443355 Centerline is valid? [True, True] Translation: X:-2.62, Y:-4.99, Z:-2.19 [[ 3.08850615e-01 -9.50835926e-01 -2.28547331e-02 -2.62197973e+00] [ 9.49068721e-01 3.09672288e-01 -5.80657928e-02 -4.99078495e+00] [ 6.22885194e-02 -3.75705647e-03 9.98051113e-01 -2.19014468e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 6.361463508999999 meters SLAMing on 6.391463508999999 meters 0.02002387040662107 Centerline is valid? [True, True] Translation: X:-2.63, Y:-5.02, Z:-2.22 [[ 3.00923766e-01 -9.53416564e-01 -2.10176705e-02 -2.62605791e+00] [ 9.51924176e-01 3.01631414e-01 -5.34682488e-02 -5.02492683e+00] [ 5.73171037e-02 -3.91736188e-03 9.98348338e-01 -2.21823951e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 6.421463509 meters 0.020975988705278215 Centerline is valid? [True, True] Translation: X:-2.64, Y:-5.06, Z:-2.22 [[ 2.93027425e-01 -9.55922507e-01 -1.86303110e-02 -2.63814900e+00] [ 9.54751670e-01 2.93593421e-01 -4.74568447e-02 -5.05638270e+00] [ 5.08348027e-02 -3.88116352e-03 9.98699534e-01 -2.21576295e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 6.451463509 meters 0.01928886395038775 Centerline is valid? [True, True] Translation: X:-2.65, Y:-5.09, Z:-2.22 [[ 3.00797865e-01 -9.53503649e-01 -1.87466362e-02 -2.65469266e+00] [ 9.52310314e-01 3.01361497e-01 -4.78154066e-02 -5.08561056e+00] [ 5.12416790e-02 -3.46984279e-03 9.98680254e-01 -2.22340851e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 6.481463508999999 meters 0.01937685408240695 Centerline is valid? [True, True] Translation: X:-2.67, Y:-5.11, Z:-2.23 [[ 3.00040482e-01 -9.53738496e-01 -1.89364995e-02 -2.67107193e+00] [ 9.52518371e-01 3.00616751e-01 -4.83561917e-02 -5.11298815e+00] [ 5.18117905e-02 -3.52854862e-03 9.98650633e-01 -2.23110346e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 6.5114635089999995 meters 0.017535083221061367 Centerline is valid? [True, True] Translation: X:-2.69, Y:-5.14, Z:-2.22 [[ 3.11040882e-01 -9.50202007e-01 -1.92279678e-02 -2.69452064e+00] [ 9.48933751e-01 3.11620639e-01 -4.91661800e-02 -5.13933209e+00] [ 5.27096346e-02 -2.95337559e-03 9.98605514e-01 -2.22198779e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 6.541463509 meters 0.016614801194390717 Centerline is valid? [True, True] Translation: X:-2.71, Y:-5.17, Z:-2.23 [[ 3.14833514e-01 -9.48961644e-01 -1.87525102e-02 -2.71172334e+00] [ 9.47749845e-01 3.15380318e-01 -4.80154692e-02 -5.16763044e+00] [ 5.14790113e-02 -2.65580972e-03 9.98670545e-01 -2.22647898e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 6.571463508999999 meters 0.017051819721960508 Centerline is valid? [True, True] Translation: X:-2.72, Y:-5.20, Z:-2.23 [[ 3.13878414e-01 -9.49303949e-01 -1.73883207e-02 -2.72240872e+00] [ 9.48259859e-01 3.14349779e-01 -4.45809017e-02 -5.19890499e+00] [ 4.77868408e-02 -2.49566381e-03 9.98854439e-01 -2.23169384e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 6.601463508999999 meters 0.0160618706324114 Centerline is valid? [True, True] Translation: X:-2.74, Y:-5.23, Z:-2.24 [[ 3.21063984e-01 -9.46881631e-01 -1.82508752e-02 -2.74097846e+00] [ 9.45724350e-01 3.21574655e-01 -4.68529176e-02 -5.22666000e+00] [ 5.02331860e-02 -2.21751272e-03 9.98735055e-01 -2.24138939e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 6.631463509 meters 0.01586300706744527 Centerline is valid? [True, True] Translation: X:-2.76, Y:-5.25, Z:-2.25 [[ 3.19909958e-01 -9.47284013e-01 -1.76243572e-02 -2.75862452e+00] [ 9.46203118e-01 3.20387605e-01 -4.52928367e-02 -5.25486647e+00] [ 4.85518057e-02 -2.18659224e-03 9.98818272e-01 -2.24696534e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 6.661463509 meters 0.014837047234286069 Centerline is valid? [True, True] Translation: X:-2.77, Y:-5.29, Z:-2.26 [[ 3.26380638e-01 -9.45062422e-01 -1.82399978e-02 -2.77138010e+00] [ 9.43897956e-01 3.26884414e-01 -4.69385577e-02 -5.28548408e+00] [ 5.03222380e-02 -1.89686025e-03 9.98731232e-01 -2.26029274e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 6.691463508999999 meters 0.014837047234286069 Centerline is valid? [True, True] Translation: X:-2.78, Y:-5.32, Z:-2.26 [[ 3.25918311e-01 -9.45222403e-01 -1.82171002e-02 -2.78376107e+00] [ 9.44057693e-01 3.26421522e-01 -4.69474485e-02 -5.31631958e+00] [ 5.03222337e-02 -1.89696048e-03 9.98731232e-01 -2.26043498e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 6.7214635089999994 meters 0.014414793262778095 Centerline is valid? [True, True] Translation: X:-2.80, Y:-5.34, Z:-2.26 [[ 3.28193039e-01 -9.44470531e-01 -1.62709875e-02 -2.80217160e+00] [ 9.43537985e-01 3.28592371e-01 -4.19895902e-02 -5.34467703e+00] [ 4.50044529e-02 -1.57160358e-03 9.98985550e-01 -2.26018410e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 6.751463509 meters 0.015130716269107149 Centerline is valid? [True, True] Translation: X:-2.82, Y:-5.37, Z:-2.24 [[ 3.24456813e-01 -9.45771914e-01 -1.55968837e-02 -2.82235022e+00] [ 9.44915031e-01 3.24827197e-01 -4.02849367e-02 -5.37133877e+00] [ 4.31666536e-02 -1.66700764e-03 9.99066495e-01 -2.24260926e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 6.781463508999999 meters 0.014759974279728213 Centerline is valid? [True, True] Translation: X:-2.84, Y:-5.40, Z:-2.24 [[ 3.26620364e-01 -9.45042509e-01 -1.46216666e-02 -2.83743954e+00] [ 9.44286695e-01 3.26944242e-01 -3.78166620e-02 -5.40131056e+00] [ 4.05188228e-02 -1.45535337e-03 9.99177715e-01 -2.23656910e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 6.811463508999999 meters 0.015460268206922234 Centerline is valid? [True, True] Translation: X:-2.85, Y:-5.43, Z:-2.26 [[ 3.22499738e-01 -9.46441777e-01 -1.55525781e-02 -2.84628946e+00] [ 9.45585856e-01 3.22869970e-01 -4.02786697e-02 -5.43293700e+00] [ 4.31428761e-02 -1.71643748e-03 9.99067438e-01 -2.25567229e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 6.8414635089999996 meters 0.014437987713444282 Centerline is valid? [True, True] Translation: X:-2.86, Y:-5.46, Z:-2.25 [[ 3.25430474e-01 -9.45431243e-01 -1.59615737e-02 -2.85871028e+00] [ 9.44525957e-01 3.25817724e-01 -4.13947709e-02 -5.46359907e+00] [ 4.43364733e-02 -1.60500075e-03 9.99015366e-01 -2.24787315e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 6.871463509 meters 0.01477656846479315 Centerline is valid? [True, True] Translation: X:-2.87, Y:-5.50, Z:-2.24 [[ 3.26669221e-01 -9.45021131e-01 -1.49091424e-02 -2.86770375e+00] [ 9.44228649e-01 3.27006147e-01 -3.87200072e-02 -5.49558950e+00] [ 4.14666062e-02 -1.42900481e-03 9.99138868e-01 -2.24377901e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 6.901463508999999 meters 0.01485279391521919 Centerline is valid? [True, True] Translation: X:-2.88, Y:-5.53, Z:-2.25 [[ 3.23546206e-01 -9.46123573e-01 -1.29628760e-02 -2.87877757e+00] [ 9.45523836e-01 3.23802966e-01 -3.37092604e-02 -5.52655800e+00] [ 3.60905436e-02 -1.35020490e-03 9.99347612e-01 -2.24945061e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 6.931463508999999 meters 0.015684724835757433 Centerline is valid? [True, True] Translation: X:-2.89, Y:-5.56, Z:-2.26 [[ 3.23362604e-01 -9.46172328e-01 -1.39482013e-02 -2.88683061e+00] [ 9.45476099e-01 3.23660073e-01 -3.63194603e-02 -5.55852384e+00] [ 3.88789442e-02 -1.44333573e-03 9.99242886e-01 -2.25928492e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 6.961463509 meters 0.01444936864157231 Centerline is valid? [True, True] Translation: X:-2.90, Y:-5.59, Z:-2.25 [[ 3.22474775e-01 -9.46499269e-01 -1.22128056e-02 -2.90221365e+00] [ 9.45964429e-01 3.22703395e-01 -3.18404887e-02 -5.58679864e+00] [ 3.40781131e-02 -1.28512527e-03 9.99418346e-01 -2.24961572e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 6.991463508999999 meters 0.014276318619382371 Centerline is valid? [True, True] Translation: X:-2.92, Y:-5.62, Z:-2.25 [[ 3.23473543e-01 -9.46166833e-01 -1.15408212e-02 -2.91813014e+00] [ 9.45687739e-01 3.23677245e-01 -3.01287452e-02 -5.61600237e+00] [ 3.22423206e-02 -1.16816112e-03 9.99479399e-01 -2.24896648e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 7.021463508999999 meters 0.01355338298537456 Centerline is valid? [True, True] Translation: X:-2.93, Y:-5.65, Z:-2.26 [[ 3.24605606e-01 -9.45788762e-01 -1.07153042e-02 -2.92859667e+00] [ 9.45374490e-01 3.24780756e-01 -2.80095180e-02 -5.64652064e+00] [ 2.99712119e-02 -1.03792867e-03 9.99550223e-01 -2.25877207e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 7.0514635089999995 meters 0.013366304128597569 Centerline is valid? [True, True] Translation: X:-2.94, Y:-5.68, Z:-2.26 [[ 3.25990925e-01 -9.45322549e-01 -9.75675739e-03 -2.94330903e+00] [ 9.44977980e-01 3.26135672e-01 -2.55370388e-02 -5.67600297e+00] [ 2.73227652e-02 -8.95077993e-04 9.99626263e-01 -2.26141009e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 7.081463509 meters 0.012436950069878007 Centerline is valid? [True, True] Translation: X:-2.96, Y:-5.70, Z:-2.27 [[ 3.26876753e-01 -9.45003970e-01 -1.09126209e-02 -2.95876005e+00] [ 9.44571556e-01 3.27057453e-01 -2.86006708e-02 -5.70381631e+00] [ 3.05968015e-02 -9.58856914e-04 9.99531348e-01 -2.27157780e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 7.111463508999999 meters 0.0120135643555829 Centerline is valid? [True, True] Translation: X:-2.97, Y:-5.73, Z:-2.27 [[ 3.32142632e-01 -9.43173542e-01 -1.02440634e-02 -2.97220751e+00] [ 9.42790914e-01 3.32299763e-01 -2.68730312e-02 -5.73348547e+00] [ 2.87500319e-02 -7.32330559e-04 9.99586364e-01 -2.27076766e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 7.141463508999999 meters 0.01159760750336317 Centerline is valid? [True, True] Translation: X:-2.99, Y:-5.76, Z:-2.28 [[ 3.33986365e-01 -9.42508221e-01 -1.14612867e-02 -2.98509892e+00] [ 9.42027622e-01 3.34182139e-01 -3.01041224e-02 -5.76384373e+00] [ 3.22035401e-02 -7.42482226e-04 9.99481056e-01 -2.27626503e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 7.171463509 meters 0.011179560964824427 Centerline is valid? [True, True] Translation: X:-3.00, Y:-5.79, Z:-2.26 [[ 3.31169752e-01 -9.43546699e-01 -6.79866397e-03 -3.00216139e+00] [ 9.43377433e-01 3.31239164e-01 -1.78783293e-02 -5.79166010e+00] [ 1.91210224e-02 -4.92944268e-04 9.99817055e-01 -2.25765941e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 7.201463508999999 meters 0.011711656795128448 Centerline is valid? [True, True] Translation: X:-3.02, Y:-5.82, Z:-2.27 [[ 3.33977744e-01 -9.42545073e-01 -8.22509468e-03 -3.02237399e+00] [ 9.42296313e-01 3.34078612e-01 -2.16596389e-02 -5.81943636e+00] [ 2.31630142e-02 -5.16639048e-04 9.99731568e-01 -2.26550629e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 7.231463508999999 meters 0.011623752688553807 Centerline is valid? [True, True] Translation: X:-3.03, Y:-5.85, Z:-2.29 [[ 3.36054470e-01 -9.41786211e-01 -1.03017618e-02 -3.02999778e+00] [ 9.41394494e-01 3.36211852e-01 -2.71660931e-02 -5.85150352e+00] [ 2.90482263e-02 -5.68734812e-04 9.99577849e-01 -2.28609346e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 7.2614635089999995 meters 0.012038092596125712 Centerline is valid? [True, True] Translation: X:-3.05, Y:-5.88, Z:-2.26 [[ 3.28509206e-01 -9.44488006e-01 -4.90997339e-03 -3.04518108e+00] [ 9.44399139e-01 3.28545678e-01 -1.29615918e-02 -5.87973237e+00] [ 1.38552185e-02 -3.78972418e-04 9.99903940e-01 -2.26194487e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 7.291463509 meters 0.011537315935555698 Centerline is valid? [True, True] Translation: X:-3.06, Y:-5.91, Z:-2.27 [[ 3.34967131e-01 -9.42202095e-01 -7.22722959e-03 -3.06474374e+00] [ 9.42008450e-01 3.35044840e-01 -1.91058959e-02 -5.90657569e+00] [ 2.04230611e-02 -4.08264220e-04 9.99791344e-01 -2.26688749e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 7.321463508999999 meters 0.012163936982991374 Centerline is valid? [True, True] Translation: X:-3.07, Y:-5.94, Z:-2.28 [[ 3.29277774e-01 -9.44206576e-01 -7.07741943e-03 -3.06829555e+00] [ 9.44020834e-01 3.29353427e-01 -1.87345826e-02 -5.93987708e+00] [ 2.00202884e-02 -5.12349745e-04 9.99799443e-01 -2.27514375e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 7.351463508999999 meters 0.011647745420147206 Centerline is valid? [True, True] Translation: X:-3.09, Y:-5.97, Z:-2.26 [[ 3.29775202e-01 -9.44048029e-01 -4.65131259e-03 -3.08638378e+00] [ 9.43967606e-01 3.29807841e-01 -1.23266342e-02 -5.96723865e+00] [ 1.31709741e-02 -3.25670129e-04 9.99913206e-01 -2.26413727e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 7.381463509 meters 0.01274850620057263 Centerline is valid? [True, True] Translation: X:-3.10, Y:-6.00, Z:-2.27 [[ 3.26203390e-01 -9.45280964e-01 -5.93694493e-03 -3.09803871e+00] [ 9.45149755e-01 3.26257071e-01 -1.57563745e-02 -5.99759022e+00] [ 1.68311712e-02 -4.71519258e-04 9.99858235e-01 -2.27126281e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 7.411463509 meters 0.012889832369483252 Centerline is valid? [True, True] Translation: X:-3.11, Y:-6.03, Z:-2.27 [[ 3.22825531e-01 -9.46447898e-01 -4.47810682e-03 -3.10838290e+00] [ 9.46373172e-01 3.22856345e-01 -1.18995955e-02 -6.02858837e+00] [ 1.27081323e-02 -3.96466928e-04 9.99919170e-01 -2.26816045e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 7.441463508999999 meters 0.013764664698800565 Centerline is valid? [True, True] Translation: X:-3.12, Y:-6.06, Z:-2.27 [[ 3.21958650e-01 -9.46747702e-01 -3.37878011e-03 -3.11628095e+00] [ 9.46705070e-01 3.21976235e-01 -8.98964550e-03 -6.06073966e+00] [ 9.59881312e-03 -3.04414130e-04 9.99953884e-01 -2.27055427e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 7.4714635089999994 meters 0.013817242653935413 Centerline is valid? [True, True] Translation: X:-3.14, Y:-6.09, Z:-2.26 [[ 3.16045968e-01 -9.48735931e-01 -3.88308861e-03 -3.13559897e+00] [ 9.48679639e-01 3.16069550e-01 -1.03432273e-02 -6.08698626e+00] [ 1.10403175e-02 -4.14871814e-04 9.99938968e-01 -2.26387658e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 7.501463509 meters 0.013241596263704547 Centerline is valid? [True, True] Translation: X:-3.14, Y:-6.12, Z:-2.27 [[ 3.19293672e-01 -9.47650942e-01 -3.04032434e-03 -3.14318787e+00] [ 9.47616310e-01 3.19308013e-01 -8.10695027e-03 -6.11891562e+00] [ 8.65335898e-03 -2.92563006e-04 9.99962516e-01 -2.27082965e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 7.531463508999999 meters 0.01367950407825272 Centerline is valid? [True, True] Translation: X:-3.15, Y:-6.15, Z:-2.27 [[ 3.16300828e-01 -9.48650814e-01 -3.92684440e-03 -3.15331120e+00] [ 9.48592939e-01 3.16324939e-01 -1.04866273e-02 -6.14879563e+00] [ 1.11903063e-02 -4.08047987e-04 9.99937303e-01 -2.26666059e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 7.561463508999999 meters 0.013869094450626139 Centerline is valid? [True, True] Translation: X:-3.17, Y:-6.18, Z:-2.26 [[ 3.18568486e-01 -9.47894293e-01 -3.24477409e-03 -3.16646040e+00] [ 9.47854638e-01 3.18584858e-01 -8.67602025e-03 -6.17836951e+00] [ 9.25768598e-03 -3.11667529e-04 9.99957098e-01 -2.26151259e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 7.5914635089999996 meters 0.013306682949135194 Centerline is valid? [True, True] Translation: X:-3.18, Y:-6.21, Z:-2.27 [[ 3.17473203e-01 -9.48264144e-01 -2.42442454e-03 -3.18004930e+00] [ 9.48241961e-01 3.17482371e-01 -6.49062539e-03 -6.20779251e+00] [ 6.92453938e-03 -2.38341441e-04 9.99975997e-01 -2.26954524e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 7.621463509 meters 0.013034256527958909 Centerline is valid? [True, True] Translation: X:-3.20, Y:-6.24, Z:-2.27 [[ 3.19400384e-01 -9.47613414e-01 -3.49474356e-03 -3.19844038e+00] [ 9.47567109e-01 3.19419344e-01 -9.37314536e-03 -6.23597420e+00] [ 9.99840697e-03 -3.17717829e-04 9.99949964e-01 -2.26849653e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 7.651463508999999 meters 0.014085440151843381 Centerline is valid? [True, True] Translation: X:-3.20, Y:-6.27, Z:-2.26 [[ 3.13211263e-01 -9.49682460e-01 -1.38929987e-03 -3.20247120e+00] [ 9.49675154e-01 3.13214307e-01 -3.72823108e-03 -6.26916453e+00] [ 3.97578426e-03 -1.51659604e-04 9.99992085e-01 -2.26447895e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 7.681463508999999 meters 0.013773696539082272 Centerline is valid? [True, True] Translation: X:-3.22, Y:-6.30, Z:-2.26 [[ 3.15802673e-01 -9.48823760e-01 -1.46418065e-03 -3.22241393e+00] [ 9.48815611e-01 3.15806033e-01 -3.93528571e-03 -6.29685487e+00] [ 4.19628967e-03 -1.46463705e-04 9.99991185e-01 -2.25649228e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 7.711463509 meters 0.013205576648827365 Centerline is valid? [True, True] Translation: X:-3.23, Y:-6.33, Z:-2.26 [[ 3.20743621e-01 -9.47162165e-01 -2.71335242e-03 -3.23316340e+00] [ 9.47134006e-01 3.20755018e-01 -7.30710328e-03 -6.32634263e+00] [ 7.79133317e-03 -2.26201586e-04 9.99969622e-01 -2.25949184e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 7.741463508999999 meters 0.012550603696480402 Centerline is valid? [True, True] Translation: X:-3.25, Y:-6.35, Z:-2.25 [[ 3.20785950e-01 -9.47151156e-01 -1.03058633e-03 -3.25202363e+00] [ 9.47147093e-01 3.20787594e-01 -2.77555667e-03 -6.35340070e+00] [ 2.95947102e-03 -8.57572673e-05 9.99995617e-01 -2.24880156e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 7.771463508999999 meters 0.012513080050624008 Centerline is valid? [True, True] Translation: X:-3.27, Y:-6.38, Z:-2.24 [[ 3.28016379e-01 -9.44663730e-01 -3.96126043e-03 -3.26910901e+00] [ 9.44603197e-01 3.28040214e-01 -1.06966693e-02 -6.38163967e+00] [ 1.14042083e-02 -2.33136524e-04 9.99934943e-01 -2.24196341e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 7.8014635089999995 meters 0.014311372109385623 Centerline is valid? [True, True] Translation: X:-3.27, Y:-6.42, Z:-2.22 [[ 3.20585647e-01 -9.47214757e-01 -3.00797926e-03 -3.27318060e+00] [ 9.47179885e-01 3.20599667e-01 -8.13134649e-03 -6.41534124e+00] [ 8.66648853e-03 -2.42304477e-04 9.99962416e-01 -2.22334395e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 7.831463509 meters 0.013182480843237157 Centerline is valid? [True, True] Translation: X:-3.29, Y:-6.44, Z:-2.22 [[ 3.26756719e-01 -9.45108086e-01 -8.66776187e-04 -3.29449213e+00] [ 9.45105184e-01 3.26757865e-01 -2.34272670e-03 -6.44082001e+00] [ 2.49735588e-03 -5.36929788e-05 9.99996880e-01 -2.22130143e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 7.861463508999999 meters 0.013411187452078477 Centerline is valid? [True, True] Translation: X:-3.31, Y:-6.47, Z:-2.23 [[ 3.24572595e-01 -9.45855848e-01 -3.05682559e-03 -3.30557955e+00] [ 9.45819582e-01 3.24586927e-01 -8.28525004e-03 -6.47003223e+00] [ 8.82885783e-03 -2.02040388e-04 9.99961004e-01 -2.23210066e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 7.891463508999999 meters 0.013626100825962016 Centerline is valid? [True, True] Translation: X:-3.32, Y:-6.50, Z:-2.22 [[ 3.20609420e-01 -9.47210715e-01 -1.20902833e-03 -3.31690318e+00] [ 9.47205047e-01 3.20611686e-01 -3.27801467e-03 -6.50028453e+00] [ 3.49259923e-03 -9.42353569e-05 9.99993896e-01 -2.22117258e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 7.921463509 meters 0.014350438214619555 Centerline is valid? [True, True] Translation: X:-3.33, Y:-6.53, Z:-2.21 [[ 3.15231621e-01 -9.49014309e-01 -9.31191659e-04 -3.32535809e+00] [ 9.49010948e-01 3.15232984e-01 -2.52689765e-03 -6.53238048e+00] [ 2.69160435e-03 -8.71530363e-05 9.99996374e-01 -2.21481803e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 7.951463508999999 meters 0.015050196397060062 Centerline is valid? [True, True] Translation: X:-3.33, Y:-6.56, Z:-2.21 [[ 3.14889064e-01 -9.49121892e-01 -3.53722191e-03 -3.33147239e+00] [ 9.49073096e-01 3.14908763e-01 -9.62964281e-03 -6.56473866e+00] [ 1.02536070e-02 -3.24812931e-04 9.99947378e-01 -2.20903832e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 7.981463508999999 meters 0.015347622012915778 Centerline is valid? [True, True] Translation: X:-3.35, Y:-6.59, Z:-2.19 [[ 3.10893399e-01 -9.50444087e-01 -1.15409924e-03 -3.34731960e+00] [ 9.50438899e-01 3.10895518e-01 -3.14278276e-03 -6.59285075e+00] [ 3.34584357e-03 -1.19830401e-04 9.99994395e-01 -2.19406921e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 8.011463509 meters 0.015169916251955188 Centerline is valid? [True, True] Translation: X:-3.36, Y:-6.62, Z:-2.20 [[ 3.12298394e-01 -9.49978108e-01 -3.36279906e-03 -3.35614836e+00] [ 9.49933816e-01 3.12316326e-01 -9.17920037e-03 -6.62407839e+00] [ 9.77029644e-03 -3.27787016e-04 9.99952216e-01 -2.19735741e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 8.041463509 meters 0.0161342587349911 Centerline is valid? [True, True] Translation: X:-3.37, Y:-6.66, Z:-2.19 [[ 3.07522199e-01 -9.51538535e-01 -2.12471936e-03 -3.36747760e+00] [ 9.51520852e-01 3.07529448e-01 -5.80579057e-03 -6.65502385e+00] [ 6.17784722e-03 -2.36305291e-04 9.99980889e-01 -2.18756981e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 8.071463509 meters 0.015624380076336071 Centerline is valid? [True, True] Translation: X:-3.38, Y:-6.68, Z:-2.19 [[ 3.06342234e-01 -9.51920426e-01 -1.39244355e-03 -3.38213755e+00] [ 9.51912821e-01 3.06345358e-01 -3.80840527e-03 -6.68316617e+00] [ 4.05186739e-03 -1.58809491e-04 9.99991779e-01 -2.18597846e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 8.101463509 meters 0.015753460941610384 Centerline is valid? [True, True] Translation: X:-3.40, Y:-6.71, Z:-2.19 [[ 3.02390853e-01 -9.53182604e-01 -1.64151680e-03 -3.39781646e+00] [ 9.53172018e-01 3.02395239e-01 -4.49705372e-03 -6.71236059e+00] [ 4.78290024e-03 -2.04779973e-04 9.99988541e-01 -2.19098127e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 8.131463509 meters 0.01727901022033069 Centerline is valid? [True, True] Translation: X:-3.40, Y:-6.75, Z:-2.18 [[ 2.95682425e-01 -9.55286083e-01 -6.35653727e-04 -3.40135755e+00] [ 9.55284502e-01 2.95683094e-01 -1.74023511e-03 -6.74596825e+00] [ 1.85037445e-03 -9.26732150e-05 9.99998284e-01 -2.17988487e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 8.161463509 meters 0.018295217082067425 Centerline is valid? [True, True] Translation: X:-3.41, Y:-6.78, Z:-2.17 [[ 2.92447163e-01 -9.56281584e-01 -4.34312649e-04 -3.41079799e+00] [ 9.56280847e-01 2.92447478e-01 -1.18948751e-03 -6.77686928e+00] [ 1.26449864e-03 -6.74626195e-05 9.99999198e-01 -2.17032100e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 8.191463509 meters 0.01635040387581066 Centerline is valid? [True, True] Translation: X:-3.43, Y:-6.80, Z:-2.17 [[ 2.99155873e-01 -9.54202175e-01 -1.99311384e-03 -3.42862793e+00] [ 9.54186446e-01 2.99162399e-01 -5.48511648e-03 -6.80435541e+00] [ 5.83017479e-03 -2.60897399e-04 9.99982970e-01 -2.16558269e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 8.221463509 meters 0.017726763292910633 Centerline is valid? [True, True] Translation: X:-3.43, Y:-6.84, Z:-2.15 [[ 2.95727722e-01 -9.55269774e-01 -2.18485123e-03 -3.43210803e+00] [ 9.55250857e-01 2.95735633e-01 -6.01956601e-03 -6.83763034e+00] [ 6.39644782e-03 -3.06928473e-04 9.99979495e-01 -2.15407085e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 8.251463509 meters 0.01641850285958323 Centerline is valid? [True, True] Translation: X:-3.45, Y:-6.87, Z:-2.15 [[ 2.95632837e-01 -9.55301023e-01 -1.08713787e-03 -3.44765296e+00] [ 9.55296335e-01 2.95634796e-01 -2.99656089e-03 -6.86614674e+00] [ 3.18401346e-03 -1.52657029e-04 9.99994919e-01 -2.14690314e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 8.281463509 meters 0.01799573206150352 Centerline is valid? [True, True] Translation: X:-3.46, Y:-6.90, Z:-2.15 [[ 2.87207479e-01 -9.57867450e-01 -1.34608938e-03 -3.45579783e+00] [ 9.57860265e-01 2.87210548e-01 -3.71672895e-03 -6.89799540e+00] [ 3.94674475e-03 -2.21893174e-04 9.99992187e-01 -2.14913019e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 8.311463509000001 meters 0.018475033695833202 Centerline is valid? [True, True] Translation: X:-3.47, Y:-6.93, Z:-2.14 [[ 2.82532298e-01 -9.59256551e-01 -1.53959335e-03 -3.47156934e+00] [ 9.59247137e-01 2.82536361e-01 -4.25842952e-03 -6.92574118e+00] [ 4.51991751e-03 -2.73706631e-04 9.99989748e-01 -2.13768077e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 8.341463509 meters 0.02169872353458298 Centerline is valid? [True, True] Translation: X:-3.47, Y:-6.96, Z:-2.13 [[ 2.70065940e-01 -9.62841828e-01 5.57378525e-05 -3.46590015e+00] [ 9.62841814e-01 2.70065945e-01 1.61149498e-04 -6.96310548e+00] [-1.70214373e-04 1.01457443e-05 9.99999985e-01 -2.13091686e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 8.371463509 meters 0.02249049995287857 Centerline is valid? [True, True] Translation: X:-3.47, Y:-7.00, Z:-2.12 [[ 2.66724287e-01 -9.63772142e-01 1.18878133e-03 -3.47233397e+00] [ 9.63766496e-01 2.66726807e-01 3.30923457e-03 -6.99643032e+00] [-3.50642793e-03 2.63054388e-04 9.99993818e-01 -2.12448542e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 8.401463509000001 meters 0.024832160242173443 Centerline is valid? [True, True] Translation: X:-3.48, Y:-7.03, Z:-2.13 [[ 2.63089329e-01 -9.64770523e-01 -1.35768043e-03 -3.47645095e+00] [ 9.64763201e-01 2.63092640e-01 -3.77195980e-03 -7.03030104e+00] [ 3.99627136e-03 -3.17477744e-04 9.99991964e-01 -2.12981355e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 8.431463509 meters 0.024996675661995118 Centerline is valid? [True, True] Translation: X:-3.48, Y:-7.06, Z:-2.13 [[ 2.53345119e-01 -9.67375796e-01 5.66024452e-04 -3.47882583e+00] [ 9.67374513e-01 2.53345709e-01 1.58241682e-03 -7.06375468e+00] [-1.67419160e-03 1.46660052e-04 9.99998588e-01 -2.13194506e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 8.461463509 meters 0.027423294622744964 Centerline is valid? [True, True] Translation: X:-3.48, Y:-7.10, Z:-2.13 [[ 2.45024305e-01 -9.69516807e-01 5.01263665e-04 -3.48124293e+00] [ 9.69515803e-01 2.45024776e-01 1.40224265e-03 -7.09884756e+00] [-1.48231983e-03 1.42399516e-04 9.99998891e-01 -2.12751915e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 8.491463509 meters 0.028985331402956862 Centerline is valid? [True, True] Translation: X:-3.48, Y:-7.13, Z:-2.12 [[ 2.37687930e-01 -9.71340633e-01 1.34973063e-03 -3.48324680e+00] [ 9.71333383e-01 2.37691402e-01 3.77588263e-03 -7.13361121e+00] [-3.98848760e-03 4.13556694e-04 9.99991960e-01 -2.11919240e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 8.521463509 meters 0.029911070778059 Centerline is valid? [True, True] Translation: X:-3.48, Y:-7.17, Z:-2.12 [[ 2.40594911e-01 -9.70625210e-01 -8.89147031e-04 -3.48464910e+00] [ 9.70622076e-01 2.40596407e-01 -2.48093754e-03 -7.16880778e+00] [ 2.62198610e-03 -2.66124791e-04 9.99996527e-01 -2.11969850e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 8.551463509 meters 0.029199519621375698 Centerline is valid? [True, True] Translation: X:-3.50, Y:-7.20, Z:-2.11 [[ 2.19453829e-01 -9.75620199e-01 2.29014925e-03 -3.49846615e+00] [ 9.75599434e-01 2.19464225e-01 6.41853919e-03 -7.19782473e+00] [-6.76466231e-03 8.25695316e-04 9.99976779e-01 -2.11274801e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 8.581463509 meters 0.029199519621375698 Centerline is valid? [True, True] Translation: X:-3.51, Y:-7.23, Z:-2.11 [[ 2.18918844e-01 -9.75740393e-01 2.28597365e-03 -3.51006645e+00] [ 9.75719621e-01 2.18929225e-01 6.42002842e-03 -7.22913948e+00] [-6.76474749e-03 8.25004142e-04 9.99976779e-01 -2.11289083e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 8.611463509 meters 0.03194633808334178 Centerline is valid? [True, True] Translation: X:-3.50, Y:-7.27, Z:-2.11 [[ 2.18170564e-01 -9.75910510e-01 5.30668217e-04 -3.50341725e+00] [ 9.75909380e-01 2.18171125e-01 1.49729221e-03 -7.26609451e+00] [-1.57699969e-03 1.91219005e-04 9.99998738e-01 -2.10755446e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 8.641463509000001 meters 0.03276954080228849 Centerline is valid? [True, True] Translation: X:-3.51, Y:-7.30, Z:-2.11 [[ 2.09611737e-01 -9.77784147e-01 1.04024969e-03 -3.50899048e+00] [ 9.77779827e-01 2.09613932e-01 2.93415953e-03 -7.29993257e+00] [-3.08702550e-03 4.02100890e-04 9.99995154e-01 -2.11055891e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 8.671463509 meters 0.033665561036893055 Centerline is valid? [True, True] Translation: X:-3.50, Y:-7.34, Z:-2.11 [[ 2.02234087e-01 -9.79336308e-01 1.33050280e-03 -3.50112444e+00] [ 9.79329253e-01 2.02237734e-01 3.75687050e-03 -7.33815656e+00] [-3.94831756e-03 5.43233040e-04 9.99992058e-01 -2.11159997e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 8.701463509 meters 0.037427553578985195 Centerline is valid? [True, True] Translation: X:-3.49, Y:-7.38, Z:-2.12 [[ 1.98746853e-01 -9.80050782e-01 3.91371676e-04 -3.48746736e+00] [ 9.80050165e-01 1.98747172e-01 1.11136585e-03 -7.37848994e+00] [-1.16697898e-03 1.62683410e-04 9.99999306e-01 -2.11994470e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 8.731463509000001 meters 0.04070845016177401 Centerline is valid? [True, True] Translation: X:-3.49, Y:-7.41, Z:-2.11 [[ 1.90182518e-01 -9.81748732e-01 -1.92416395e-04 -3.48654245e+00] [ 9.81748588e-01 1.90182596e-01 -5.37970041e-04 -7.41466274e+00] [ 5.64745655e-04 -8.65920267e-05 9.99999837e-01 -2.11001129e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 8.761463509 meters 0.038898404076862285 Centerline is valid? [True, True] Translation: X:-3.49, Y:-7.45, Z:-2.13 [[ 1.82360939e-01 -9.83231652e-01 7.58892614e-05 -3.49201920e+00] [ 9.83231628e-01 1.82360952e-01 2.20884746e-04 -7.44732681e+00] [-2.31020111e-04 3.43359724e-05 9.99999973e-01 -2.12515267e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 8.791463509 meters 0.04237519527459378 Centerline is valid? [True, True] Translation: X:-3.48, Y:-7.49, Z:-2.13 [[ 1.74885002e-01 -9.84588754e-01 4.71164002e-04 -3.47915013e+00] [ 9.84587867e-01 1.74885486e-01 1.34105185e-03 -7.48718668e+00] [-1.40278431e-03 2.29372504e-04 9.99998990e-01 -2.12744970e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 8.821463509 meters 0.038434416403952405 Centerline is valid? [True, True] Translation: X:-3.50, Y:-7.51, Z:-2.13 [[ 1.68196296e-01 -9.85753521e-01 -3.35287066e-05 -3.50346124e+00] [ 9.85753517e-01 1.68196298e-01 -9.02405896e-05 -7.51356441e+00] [ 9.45943833e-05 -1.78729076e-05 9.99999995e-01 -2.12727094e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 8.851463509 meters 0.04401072203053121 Centerline is valid? [True, True] Translation: X:-3.49, Y:-7.56, Z:-2.12 [[ 1.62646344e-01 -9.86684362e-01 3.70258412e-04 -3.48678539e+00] [ 9.86683814e-01 1.62646650e-01 1.05746079e-03 -7.55500121e+00] [-1.10360132e-03 1.93335851e-04 9.99999372e-01 -2.12380446e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 8.881463509 meters 0.03807794440190694 Centerline is valid? [True, True] Translation: X:-3.50, Y:-7.58, Z:-2.14 [[ 1.63437658e-01 -9.86553354e-01 -7.81575040e-04 -3.50451803e+00] [ 9.86550942e-01 1.63439017e-01 -2.21971325e-03 -7.58297224e+00] [ 2.31760541e-03 -4.08278858e-04 9.99997231e-01 -2.13827613e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 8.911463509 meters 0.03948404841599701 Centerline is valid? [True, True] Translation: X:-3.52, Y:-7.62, Z:-2.11 [[ 1.52115044e-01 -9.88362579e-01 6.52013330e-04 -3.51501276e+00] [ 9.88360891e-01 1.52116013e-01 1.86243386e-03 -7.61535592e+00] [-1.93994160e-03 3.61120266e-04 9.99998053e-01 -2.10906015e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 8.941463509 meters 0.041162098503591336 Centerline is valid? [True, True] Translation: X:-3.52, Y:-7.65, Z:-2.11 [[ 1.58040736e-01 -9.87432373e-01 -6.58622891e-04 -3.51644066e+00] [ 9.87430661e-01 1.58041711e-01 -1.87267304e-03 -7.65078085e+00] [ 1.95322787e-03 -3.54385813e-04 9.99998030e-01 -2.10926848e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 8.971463509 meters 0.04109728380981154 Centerline is valid? [True, True] Translation: X:-3.52, Y:-7.68, Z:-2.11 [[ 1.58785558e-01 -9.87311352e-01 -1.85494237e-03 -3.52143659e+00] [ 9.87297646e-01 1.58793303e-01 -5.29570057e-03 -7.68445598e+00] [ 5.52305771e-03 -9.90499466e-04 9.99984257e-01 -2.10796438e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 9.001463509 meters 0.039292576381462316 Centerline is valid? [True, True] Translation: X:-3.54, Y:-7.71, Z:-2.11 [[ 1.56905390e-01 -9.87612649e-01 -1.39808084e-03 -3.53750603e+00] [ 9.87604852e-01 1.56909808e-01 -3.99610121e-03 -7.71351889e+00] [ 4.16597270e-03 -7.53741600e-04 9.99991038e-01 -2.10757149e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 9.031463509 meters 0.04006396169800126 Centerline is valid? [True, True] Translation: X:-3.54, Y:-7.75, Z:-2.11 [[ 1.56557356e-01 -9.87667788e-01 -1.46078294e-03 -3.53952561e+00] [ 9.87659249e-01 1.56562188e-01 -4.18202196e-03 -7.74847811e+00] [ 4.35915175e-03 -7.88029475e-04 9.99990188e-01 -2.10584554e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 9.061463509000001 meters 0.03626824551079448 Centerline is valid? [True, True] Translation: X:-3.57, Y:-7.77, Z:-2.09 [[ 1.70400093e-01 -9.85368592e-01 -3.54195088e-03 -3.56817543e+00] [ 9.85317751e-01 1.70427832e-01 -1.01628839e-02 -7.77322661e+00] [ 1.06178336e-02 -1.75819072e-03 9.99942084e-01 -2.09165644e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 9.091463509 meters 0.04037437260969627 Centerline is valid? [True, True] Translation: X:-3.55, Y:-7.82, Z:-2.12 [[ 1.74423543e-01 -9.84665528e-01 -3.19777929e-03 -3.54606196e+00] [ 9.84623873e-01 1.74446004e-01 -9.18807153e-03 -7.81678970e+00] [ 9.60501712e-03 -1.54599384e-03 9.99952676e-01 -2.11661937e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 9.121463509 meters 0.03630592496964822 Centerline is valid? [True, True] Translation: X:-3.59, Y:-7.84, Z:-2.09 [[ 1.69338575e-01 -9.85555054e-01 -2.38385303e-03 -3.59036761e+00] [ 9.85531902e-01 1.69351187e-01 -6.85894578e-03 -7.83651620e+00] [ 7.16357702e-03 -1.18787911e-03 9.99973636e-01 -2.08794809e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 9.151463509000001 meters 0.036890730094912644 Centerline is valid? [True, True] Translation: X:-3.60, Y:-7.87, Z:-2.10 [[ 1.68318134e-01 -9.85730079e-01 -2.28394115e-03 -3.60033948e+00] [ 9.85708768e-01 1.68329745e-01 -6.58197046e-03 -7.86909792e+00] [ 6.87250149e-03 -1.14343583e-03 9.99975730e-01 -2.09836026e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 9.181463509 meters 0.034706745766294136 Centerline is valid? [True, True] Translation: X:-3.62, Y:-7.90, Z:-2.09 [[ 1.75819315e-01 -9.84419249e-01 -2.51219122e-03 -3.61662275e+00] [ 9.84393270e-01 1.75833180e-01 -7.25142764e-03 -7.89947578e+00] [ 7.58017153e-03 -1.19804309e-03 9.99970552e-01 -2.09337537e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 9.211463509 meters 0.03241816766867216 Centerline is valid? [True, True] Translation: X:-3.63, Y:-7.93, Z:-2.09 [[ 1.85300333e-01 -9.82676236e-01 -3.34678492e-03 -3.63272340e+00] [ 9.82629760e-01 1.85324515e-01 -9.67363683e-03 -7.92924546e+00] [ 1.01262943e-02 -1.49612234e-03 9.99947609e-01 -2.09081271e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 9.241463509 meters 0.03310314651962944 Centerline is valid? [True, True] Translation: X:-3.65, Y:-7.96, Z:-2.10 [[ 1.88017684e-01 -9.82161206e-01 -2.95214345e-03 -3.65135710e+00] [ 9.82124889e-01 1.88036414e-01 -8.54458935e-03 -7.95836446e+00] [ 8.94727466e-03 -1.29283966e-03 9.99959137e-01 -2.09547087e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 9.271463509 meters 0.03493844691291368 Centerline is valid? [True, True] Translation: X:-3.66, Y:-7.99, Z:-2.07 [[ 1.92719690e-01 -9.81249009e-01 -3.08290211e-03 -3.65594163e+00] [ 9.81209165e-01 1.92739946e-01 -8.93797345e-03 -7.99209848e+00] [ 9.36457597e-03 -1.30244833e-03 9.99955303e-01 -2.07271123e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 9.301463509 meters 0.028438264468562756 Centerline is valid? [True, True] Translation: X:-3.68, Y:-8.02, Z:-2.08 [[ 2.13507946e-01 -9.76930896e-01 -4.51447951e-03 -3.68312304e+00] [ 9.76844276e-01 2.13549590e-01 -1.31085066e-02 -8.01720153e+00] [ 1.37701704e-02 -1.61117314e-03 9.99903889e-01 -2.08411879e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 9.331463509 meters 0.02715803494940527 Centerline is valid? [True, True] Translation: X:-3.71, Y:-8.04, Z:-2.07 [[ 2.13641963e-01 -9.76906139e-01 -3.39228607e-03 -3.70899963e+00] [ 9.76857109e-01 2.13665484e-01 -9.86152836e-03 -8.04221743e+00] [ 1.03586020e-02 -1.20694248e-03 9.99945620e-01 -2.07376733e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 9.361463509 meters 0.026996651329751594 Centerline is valid? [True, True] Translation: X:-3.72, Y:-8.07, Z:-2.08 [[ 2.27906893e-01 -9.73670918e-01 -4.83647488e-03 -3.72245809e+00] [ 9.73570276e-01 2.27953270e-01 -1.40792118e-02 -8.07256758e+00] [ 1.48110094e-02 -1.49989877e-03 9.99889186e-01 -2.07834335e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 9.391463509 meters 0.02575301969126775 Centerline is valid? [True, True] Translation: X:-3.74, Y:-8.10, Z:-2.08 [[ 2.25418004e-01 -9.74254455e-01 -3.87059259e-03 -3.74249115e+00] [ 9.74189953e-01 2.25447885e-01 -1.12777260e-02 -8.09958914e+00] [ 1.18599917e-02 -1.22848995e-03 9.99928913e-01 -2.07939760e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 9.421463509 meters 0.021972055201710264 Centerline is valid? [True, True] Translation: X:-3.77, Y:-8.13, Z:-2.09 [[ 2.48242811e-01 -9.68681158e-01 -5.68516800e-03 -3.76789369e+00] [ 9.68540168e-01 2.48304016e-01 -1.65849129e-02 -8.12628910e+00] [ 1.74771427e-02 -1.38922818e-03 9.99846298e-01 -2.08815184e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 9.451463509 meters 0.020312762478863513 Centerline is valid? [True, True] Translation: X:-3.78, Y:-8.16, Z:-2.08 [[ 2.51803110e-01 -9.67765885e-01 -4.93825762e-03 -3.78201592e+00] [ 9.67659045e-01 2.51848921e-01 -1.44254307e-02 -8.15581869e+00] [ 1.52041346e-02 -1.14618133e-03 9.99883754e-01 -2.08411733e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 9.481463509000001 meters 0.020096072304647057 Centerline is valid? [True, True] Translation: X:-3.80, Y:-8.19, Z:-2.09 [[ 2.59825741e-01 -9.65638017e-01 -5.81417303e-03 -3.80098472e+00] [ 9.65488989e-01 2.59888039e-01 -1.70064297e-02 -8.18502332e+00] [ 1.79330891e-02 -1.19481184e-03 9.99838475e-01 -2.09441789e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 9.511463509 meters 0.018889164581143078 Centerline is valid? [True, True] Translation: X:-3.82, Y:-8.21, Z:-2.09 [[ 2.59052676e-01 -9.65855070e-01 -3.96163688e-03 -3.82297638e+00] [ 9.65785725e-01 2.59081667e-01 -1.16026896e-02 -8.21160316e+00] [ 1.22329041e-02 -8.20384547e-04 9.99924839e-01 -2.08691530e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 9.541463509 meters 0.015325954758949479 Centerline is valid? [True, True] Translation: X:-3.84, Y:-8.24, Z:-2.10 [[ 2.80894223e-01 -9.59718398e-01 -6.24758306e-03 -3.84238117e+00] [ 9.59543843e-01 2.80962414e-01 -1.83230757e-02 -8.23980535e+00] [ 1.93403288e-02 -8.47983751e-04 9.99812599e-01 -2.10014580e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 9.571463509 meters 0.014581688416723628 Centerline is valid? [True, True] Translation: X:-3.87, Y:-8.26, Z:-2.10 [[ 2.82698526e-01 -9.59191809e-01 -5.71114509e-03 -3.86568722e+00] [ 9.59045586e-01 2.82755246e-01 -1.67641168e-02 -8.26495781e+00] [ 1.76948598e-02 -7.38057372e-04 9.99843161e-01 -2.10104296e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 9.601463509 meters 0.012068581261455841 Centerline is valid? [True, True] Translation: X:-3.89, Y:-8.29, Z:-2.12 [[ 3.13814866e-01 -9.49439378e-01 -9.22487416e-03 -3.88504387e+00] [ 9.49052002e-01 3.13950328e-01 -2.71198960e-02 -8.29298673e+00] [ 2.86448494e-02 -2.44258786e-04 9.99589622e-01 -2.12448648e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 9.631463509 meters 0.011807559786506381 Centerline is valid? [True, True] Translation: X:-3.91, Y:-8.32, Z:-2.11 [[ 3.01275488e-01 -9.53522186e-01 -5.34046178e-03 -3.90784437e+00] [ 9.53392750e-01 3.01322605e-01 -1.57146909e-02 -8.31914508e+00] [ 1.65935083e-02 -3.57106367e-04 9.99862254e-01 -2.10562119e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 9.661463509 meters 0.011689007520252282 Centerline is valid? [True, True] Translation: X:-3.93, Y:-8.35, Z:-2.11 [[ 3.14925727e-01 -9.49099191e-01 -5.70190602e-03 -3.93094966e+00] [ 9.48950465e-01 3.14977318e-01 -1.68018781e-02 -8.34633159e+00] [ 1.77426200e-02 -1.19482702e-04 9.99842580e-01 -2.11019008e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 9.691463509 meters 0.011645956881065503 Centerline is valid? [True, True] Translation: X:-3.96, Y:-8.37, Z:-2.11 [[ 3.30598734e-01 -9.43745201e-01 -7.03364055e-03 -3.95783522e+00] [ 9.43516935e-01 3.30673471e-01 -2.07568995e-02 -8.37135515e+00] [ 2.19150626e-02 2.25845712e-04 9.99759811e-01 -2.10780116e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 9.721463509 meters 0.013645089922734464 Centerline is valid? [True, True] Translation: X:-3.99, Y:-8.40, Z:-2.11 [[ 3.44813753e-01 -9.38642463e-01 -7.33499974e-03 -3.98505994e+00] [ 9.38392269e-01 3.44891253e-01 -2.16788555e-02 -8.39720117e+00] [ 2.28784716e-02 5.92060499e-04 9.99738078e-01 -2.10704777e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 9.751463509 meters 0.01615723700687632 Centerline is valid? [True, True] Translation: X:-4.00, Y:-8.43, Z:-2.13 [[ 3.65106281e-01 -9.30929411e-01 -8.23618701e-03 -4.00255009e+00] [ 9.30610937e-01 3.65197073e-01 -2.43799366e-02 -8.42501363e+00] [ 2.57038314e-02 1.23658229e-03 9.99668837e-01 -2.13223764e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 9.781463509 meters 0.01831984906771408 Centerline is valid? [True, True] Translation: X:-4.03, Y:-8.45, Z:-2.13 [[ 3.72782791e-01 -9.27877660e-01 -8.72008055e-03 -4.03421649e+00] [ 9.27518768e-01 3.72881549e-01 -2.58512145e-02 -8.44869474e+00] [ 2.72383216e-02 1.54884951e-03 9.99627768e-01 -2.12804613e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 9.811463509000001 meters 0.017725303841770665 Centerline is valid? [True, True] Translation: X:-4.05, Y:-8.48, Z:-2.12 [[ 3.74614870e-01 -9.27146650e-01 -7.92396345e-03 -4.05266277e+00] [ 9.26849364e-01 3.74695791e-01 -2.35227540e-02 -8.47560500e+00] [ 2.47781183e-02 1.46765296e-03 9.99691898e-01 -2.11736605e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 9.841463509 meters 0.02244965594691597 Centerline is valid? [True, True] Translation: X:-4.08, Y:-8.50, Z:-2.12 [[ 3.90235287e-01 -9.20670760e-01 -9.04277417e-03 -4.08153997e+00] [ 9.20280742e-01 3.90334020e-01 -2.68832618e-02 -8.49995939e+00] [ 2.82803354e-02 2.16890645e-03 9.99597678e-01 -2.12064804e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 9.871463509 meters 0.02666193639377811 Centerline is valid? [True, True] Translation: X:-4.11, Y:-8.52, Z:-2.12 [[ 3.99200746e-01 -9.16825523e-01 -8.35009818e-03 -4.11069717e+00] [ 9.16491221e-01 3.99281605e-01 -2.48604600e-02 -8.52471707e+00] [ 2.61267448e-02 2.27152250e-03 9.99656058e-01 -2.12444330e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 9.901463509000001 meters 0.024923590670191575 Centerline is valid? [True, True] Translation: X:-4.13, Y:-8.55, Z:-2.13 [[ 4.02969573e-01 -9.15179773e-01 -7.84254678e-03 -4.12792758e+00] [ 9.14883798e-01 4.03039617e-01 -2.33816981e-02 -8.55226063e+00] [ 2.45593142e-02 2.24709391e-03 9.99695849e-01 -2.12500315e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 9.931463509 meters 0.0327873232410063 Centerline is valid? [True, True] Translation: X:-4.16, Y:-8.57, Z:-2.14 [[ 4.12639531e-01 -9.10853917e-01 -8.58830251e-03 -4.16470541e+00] [ 9.10497032e-01 4.12719652e-01 -2.56445563e-02 -8.57458873e+00] [ 2.69030057e-02 2.76233371e-03 9.99634232e-01 -2.13759726e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 9.961463509 meters 0.030949529341390794 Centerline is valid? [True, True] Translation: X:-4.18, Y:-8.60, Z:-2.14 [[ 4.18718841e-01 -9.08079397e-01 -8.14504952e-03 -4.17994300e+00] [ 9.07757078e-01 4.18788666e-01 -2.43544876e-02 -8.60273738e+00] [ 2.55268628e-02 2.80395645e-03 9.99670204e-01 -2.13928229e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 9.991463509 meters 0.03628273338669611 Centerline is valid? [True, True] Translation: X:-4.21, Y:-8.63, Z:-2.15 [[ 4.27981796e-01 -9.03751650e-01 -8.03348135e-03 -4.21437790e+00] [ 9.03436861e-01 4.28046445e-01 -2.40432629e-02 -8.62580776e+00] [ 2.51678417e-02 3.03233566e-03 9.99678641e-01 -2.14559507e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 10.021463509 meters 0.0381374578182945 Centerline is valid? [True, True] Translation: X:-4.24, Y:-8.65, Z:-2.15 [[ 4.31594946e-01 -9.02031897e-01 -8.01616107e-03 -4.23650034e+00] [ 9.01717382e-01 4.31657959e-01 -2.40243457e-02 -8.65356993e+00] [ 2.51309658e-02 3.14047440e-03 9.99679235e-01 -2.15029257e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 10.051463509 meters 0.038798358613806094 Centerline is valid? [True, True] Translation: X:-4.26, Y:-8.68, Z:-2.16 [[ 4.38095308e-01 -8.98893996e-01 -7.87941750e-03 -4.26140641e+00] [ 8.98589103e-01 4.38153918e-01 -2.36382734e-02 -8.68014462e+00] [ 2.47006997e-02 3.27545797e-03 9.99689525e-01 -2.15794749e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 10.081463509 meters 0.04511875983232846 Centerline is valid? [True, True] Translation: X:-4.29, Y:-8.71, Z:-2.17 [[ 4.49864285e-01 -8.93044627e-01 -9.66535145e-03 -4.28774711e+00] [ 8.92583953e-01 4.49946313e-01 -2.90207302e-02 -8.70540618e+00] [ 3.02656964e-02 4.42825245e-03 9.99532080e-01 -2.17307088e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 10.111463509 meters 0.046626096703223326 Centerline is valid? [True, True] Translation: X:-4.31, Y:-8.73, Z:-2.17 [[ 4.55115734e-01 -8.90383747e-01 -9.29799585e-03 -4.30615329e+00] [ 8.89956042e-01 4.55188992e-01 -2.79504105e-02 -8.73278151e+00] [ 2.91189366e-02 4.44586401e-03 9.99566067e-01 -2.17484719e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 10.141463509 meters 0.048822654560234054 Centerline is valid? [True, True] Translation: X:-4.33, Y:-8.76, Z:-2.17 [[ 4.58030775e-01 -8.88883938e-01 -9.65159150e-03 -4.33027105e+00] [ 8.88421619e-01 4.58108009e-01 -2.90530411e-02 -8.75942625e+00] [ 3.02462530e-02 4.73250440e-03 9.99531274e-01 -2.17155893e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 10.171463509 meters 0.05142120956136925 Centerline is valid? [True, True] Translation: X:-4.35, Y:-8.79, Z:-2.19 [[ 4.62374115e-01 -8.86636997e-01 -9.22027220e-03 -4.35146091e+00] [ 8.86213665e-01 4.62442365e-01 -2.77920666e-02 -8.78648170e+00] [ 2.89053190e-02 4.67920100e-03 9.99571202e-01 -2.18532340e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 10.201463509 meters 0.060398583291682836 Centerline is valid? [True, True] Translation: X:-4.39, Y:-8.81, Z:-2.19 [[ 4.61394113e-01 -8.87141380e-01 -9.77982773e-03 -4.39450017e+00] [ 8.86664033e-01 4.61471233e-01 -2.95159787e-02 -8.80570370e+00] [ 3.06979552e-02 4.94707732e-03 9.99516464e-01 -2.18775939e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 10.231463509000001 meters 0.050352861889621604 Centerline is valid? [True, True] Translation: X:-4.38, Y:-8.84, Z:-2.19 [[ 4.60840633e-01 -8.87435256e-01 -9.19662727e-03 -4.38205531e+00] [ 8.87012196e-01 4.60908938e-01 -2.77905461e-02 -8.84341202e+00] [ 2.89011181e-02 4.64949230e-03 9.99571462e-01 -2.19322004e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 10.261463509 meters 0.06425025882270277 Centerline is valid? [True, True] Translation: X:-4.43, Y:-8.86, Z:-2.21 [[ 4.61240378e-01 -8.87224014e-01 -9.53217286e-03 -4.43208157e+00] [ 8.86768372e-01 4.61313371e-01 -2.88414426e-02 -8.86056770e+00] [ 2.99861393e-02 4.85000848e-03 9.99538548e-01 -2.20605595e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 10.291463509 meters 0.06297566471027083 Centerline is valid? [True, True] Translation: X:-4.44, Y:-8.89, Z:-2.21 [[ 4.59441800e-01 -8.88156307e-01 -9.57113856e-03 -4.44426323e+00] [ 8.87695995e-01 4.59516147e-01 -2.89953558e-02 -8.89055229e+00] [ 3.01505009e-02 4.82541709e-03 9.99533723e-01 -2.21304176e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 10.321463509 meters 0.06043014618814596 Centerline is valid? [True, True] Translation: X:-4.45, Y:-8.92, Z:-2.21 [[ 4.54116426e-01 -8.90886348e-01 -9.98929290e-03 -4.45269271e+00] [ 8.90384657e-01 4.54200289e-01 -3.02862905e-02 -8.92118005e+00] [ 3.15187825e-02 4.85918887e-03 9.99491348e-01 -2.21422301e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 10.351463509 meters 0.05738749158178009 Centerline is valid? [True, True] Translation: X:-4.46, Y:-8.95, Z:-2.22 [[ 4.47509737e-01 -8.94237209e-01 -8.65158223e-03 -4.46369735e+00] [ 8.93860531e-01 4.47575313e-01 -2.62619538e-02 -8.95235163e+00] [ 2.73566509e-02 4.01917215e-03 9.99617657e-01 -2.21949065e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 10.381463509 meters 0.05544812631222623 Centerline is valid? [True, True] Translation: X:-4.47, Y:-8.98, Z:-2.22 [[ 4.42412658e-01 -8.96762606e-01 -9.37385116e-03 -4.47192734e+00] [ 8.96320092e-01 4.42492043e-01 -2.84795479e-02 -8.98359579e+00] [ 2.96872482e-02 4.19774136e-03 9.99550422e-01 -2.22261071e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 10.411463509 meters 0.052667527413002284 Centerline is valid? [True, True] Translation: X:-4.48, Y:-9.01, Z:-2.23 [[ 4.35304111e-01 -9.00234623e-01 -9.37841550e-03 -4.48207073e+00] [ 8.99791650e-01 4.35386986e-01 -2.85159459e-02 -9.01406013e+00] [ 2.97542819e-02 3.97448852e-03 9.99549342e-01 -2.22594030e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 10.441463509 meters 0.04896261346395924 Centerline is valid? [True, True] Translation: X:-4.49, Y:-9.04, Z:-2.23 [[ 4.29033844e-01 -9.03240799e-01 -9.27472637e-03 -4.48862213e+00] [ 9.02807508e-01 4.29117827e-01 -2.82222258e-02 -9.04484321e+00] [ 2.94714162e-02 3.73499742e-03 9.99558645e-01 -2.23438844e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 10.471463509 meters 0.045978612089217274 Centerline is valid? [True, True] Translation: X:-4.50, Y:-9.08, Z:-2.23 [[ 4.22981703e-01 -9.06091951e-01 -9.15727047e-03 -4.49664154e+00] [ 9.05669155e-01 4.23066281e-01 -2.78981090e-02 -9.07583398e+00] [ 2.91523843e-02 3.50693222e-03 9.99568827e-01 -2.23183282e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 10.501463509 meters 0.045978612089217274 Centerline is valid? [True, True] Translation: X:-4.51, Y:-9.11, Z:-2.23 [[ 4.22601031e-01 -9.06269675e-01 -9.14572314e-03 -4.50709207e+00] [ 9.05846845e-01 4.22685437e-01 -2.79018962e-02 -9.10685685e+00] [ 2.91524064e-02 3.50674566e-03 9.99568827e-01 -2.23197232e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 10.531463509 meters 0.043987578524282575 Centerline is valid? [True, True] Translation: X:-4.52, Y:-9.14, Z:-2.24 [[ 4.17052286e-01 -9.08836903e-01 -9.10356627e-03 -4.52118324e+00] [ 9.08417759e-01 4.17138393e-01 -2.77981272e-02 -9.13518992e+00] [ 2.90614108e-02 3.32343121e-03 9.99572103e-01 -2.23769051e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 10.561463509 meters 0.04164500193345428 Centerline is valid? [True, True] Translation: X:-4.53, Y:-9.16, Z:-2.25 [[ 4.12135762e-01 -9.11069133e-01 -9.85641117e-03 -4.53097934e+00] [ 9.10577577e-01 4.12239262e-01 -3.01208850e-02 -9.16480723e+00] [ 3.15054082e-02 3.43886686e-03 9.99497666e-01 -2.24754749e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 10.591463509 meters 0.03971266354487262 Centerline is valid? [True, True] Translation: X:-4.54, Y:-9.20, Z:-2.26 [[ 4.05600329e-01 -9.14001456e-01 -9.47166742e-03 -4.54186847e+00] [ 9.13547511e-01 4.05699085e-01 -2.89688891e-02 -9.19507985e+00] [ 3.03202536e-02 3.09697272e-03 9.99535438e-01 -2.25729056e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 10.621463509 meters 0.035441576041635434 Centerline is valid? [True, True] Translation: X:-4.55, Y:-9.23, Z:-2.26 [[ 3.98141863e-01 -9.17280404e-01 -8.92843164e-03 -4.54550317e+00] [ 9.16876788e-01 3.98232810e-01 -2.73419905e-02 -9.22738035e+00] [ 2.86358666e-02 2.69971932e-03 9.99586264e-01 -2.25922592e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 10.651463509000001 meters 0.03316622643488416 Centerline is valid? [True, True] Translation: X:-4.56, Y:-9.26, Z:-2.28 [[ 3.89494822e-01 -9.20977847e-01 -9.67416902e-03 -4.55769378e+00] [ 9.20503647e-01 3.89605928e-01 -2.96691197e-02 -9.25754850e+00] [ 3.10937155e-02 2.65086062e-03 9.99512958e-01 -2.27664977e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 10.681463509 meters 0.028288162646858545 Centerline is valid? [True, True] Translation: X:-4.56, Y:-9.29, Z:-2.27 [[ 3.75954630e-01 -9.26588681e-01 -9.56724053e-03 -4.55988618e+00] [ 9.26125227e-01 3.76069986e-01 -2.93841756e-02 -9.29052338e+00] [ 3.08249965e-02 2.18665405e-03 9.99522405e-01 -2.27399740e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 10.711463509 meters 0.02313710170627961 Centerline is valid? [True, True] Translation: X:-4.56, Y:-9.32, Z:-2.29 [[ 3.60891758e-01 -9.32548501e-01 -1.05086752e-02 -4.55858302e+00] [ 9.31990029e-01 3.61039875e-01 -3.23232701e-02 -9.32389301e+00] [ 3.39370679e-02 1.87122124e-03 9.99422220e-01 -2.28712380e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 10.741463509 meters 0.01970773079704822 Centerline is valid? [True, True] Translation: X:-4.56, Y:-9.36, Z:-2.29 [[ 3.46783633e-01 -9.37899619e-01 -9.24212078e-03 -4.56256586e+00] [ 9.37468625e-01 3.46904678e-01 -2.84556118e-02 -9.35707244e+00] [ 2.98946424e-02 1.20374217e-03 9.99552330e-01 -2.29179520e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 10.771463509 meters 0.015357036213126351 Centerline is valid? [True, True] Translation: X:-4.57, Y:-9.39, Z:-2.31 [[ 3.31135621e-01 -9.43527623e-01 -1.02383855e-02 -4.56568976e+00] [ 9.42999680e-01 3.31292900e-01 -3.15692591e-02 -9.38904882e+00] [ 3.31783724e-02 7.98911969e-04 9.99449127e-01 -2.30542079e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 10.801463509 meters 0.012763559891721397 Centerline is valid? [True, True] Translation: X:-4.56, Y:-9.42, Z:-2.31 [[ 3.11841386e-01 -9.50093919e-01 -8.74620583e-03 -4.56319979e+00] [ 9.49709910e-01 3.11963992e-01 -2.70102724e-02 -9.42317049e+00] [ 2.83907968e-02 1.16562420e-04 9.99596893e-01 -2.31343175e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 10.831463509 meters 0.016202886072424275 Centerline is valid? [True, True] Translation: X:-4.56, Y:-9.46, Z:-2.34 [[ 2.91990320e-01 -9.56363264e-01 -1.05337776e-02 -4.55733375e+00] [ 9.55808780e-01 2.92179730e-01 -3.25665560e-02 -9.45931243e+00] [ 3.42232141e-02 -5.59158024e-04 9.99414058e-01 -2.33621214e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 10.861463509 meters 0.02152175479584093 Centerline is valid? [True, True] Translation: X:-4.55, Y:-9.50, Z:-2.33 [[ 2.77834220e-01 -9.60586625e-01 -9.02679007e-03 -4.55231077e+00] [ 9.60180503e-01 2.77979352e-01 -2.79442626e-02 -9.49567054e+00] [ 2.93521461e-02 -9.03475440e-04 9.99568725e-01 -2.33409537e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 10.891463509 meters 0.023316373183850728 Centerline is valid? [True, True] Translation: X:-4.55, Y:-9.53, Z:-2.35 [[ 2.70295566e-01 -9.62740426e-01 -8.43676447e-03 -4.55296317e+00] [ 9.62385679e-01 2.70425164e-01 -2.61540705e-02 -9.52936232e+00] [ 2.74610944e-02 -1.05009202e-03 9.99622321e-01 -2.35074210e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 10.921463509 meters 0.035247627055173515 Centerline is valid? [True, True] Translation: X:-4.54, Y:-9.57, Z:-2.35 [[ 2.55507319e-01 -9.66761576e-01 -9.38433555e-03 -4.54402462e+00] [ 9.66323781e-01 2.55674440e-01 -2.91364232e-02 -9.56728087e+00] [ 3.05673091e-02 -1.62373722e-03 9.99531392e-01 -2.34986162e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 10.951463509 meters 0.050793946736487565 Centerline is valid? [True, True] Translation: X:-4.53, Y:-9.61, Z:-2.34 [[ 2.33253869e-01 -9.72355341e-01 -1.08500417e-02 -4.53183389e+00] [ 9.71773860e-01 2.33490744e-01 -3.37288857e-02 -9.60679155e+00] [ 3.53298465e-02 -2.67639379e-03 9.99372122e-01 -2.33599313e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 10.981463509000001 meters 0.05022587002873275 Centerline is valid? [True, True] Translation: X:-4.53, Y:-9.64, Z:-2.34 [[ 2.25452418e-01 -9.74203889e-01 -9.89903031e-03 -4.53158763e+00] [ 9.73720069e-01 2.25653587e-01 -3.08169781e-02 -9.64238200e+00] [ 3.22557716e-02 -2.69112227e-03 9.99476024e-01 -2.33882654e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 11.011463509 meters 0.07185527865023841 Centerline is valid? [True, True] Translation: X:-4.50, Y:-9.69, Z:-2.12 [[ 0.19865618 -0.97964707 -0.02876357 -4.49533645] [ 0.97558869 0.20046593 -0.08966673 -9.69046527] [ 0.09360787 -0.01024856 0.99555639 -2.11512943] [ 0. 0. 0. 1. ]] SLAMing on 11.041463509 meters 0.07632679233230406 Centerline is valid? [True, True] Translation: X:-4.50, Y:-9.73, Z:-2.17 [[ 0.19009355 -0.98138377 -0.02739228 -4.49872285] [ 0.97770974 0.1917681 -0.08549068 -9.72529368] [ 0.08915213 -0.01053047 0.99596235 -2.17285675] [ 0. 0. 0. 1. ]] SLAMing on 11.071463509 meters 0.07408908963053541 Centerline is valid? [True, True] Translation: X:-4.49, Y:-9.76, Z:-2.03 [[ 0.20675186 -0.9774233 -0.04355866 -4.49243047] [ 0.9680009 0.21082468 -0.13611471 -9.76376058] [ 0.14222493 -0.01402286 0.98973503 -2.03214208] [ 0. 0. 0. 1. ]] SLAMing on 11.101463509 meters 0.09068318233694914 Centerline is valid? [True, True] Translation: X:-4.49, Y:-9.80, Z:-2.07 [[ 0.22131334 -0.97304217 -0.06487946 -4.48919005] [ 0.95178069 0.23001273 -0.20299668 -9.80039151] [ 0.21244743 -0.01682514 0.97702764 -2.06963618] [ 0. 0. 0. 1. ]] SLAMing on 11.131463509 meters 0.09368958381466996 Centerline is valid? [True, True] Translation: X:-4.50, Y:-9.83, Z:-2.08 [[ 0.23818685 -0.96845286 -0.07325361 -4.50263097] [ 0.94097781 0.248788 -0.22948919 -9.83109509] [ 0.24047408 -0.01426871 0.97055068 -2.0755209 ] [ 0. 0. 0. 1. ]] SLAMing on 11.161463509 meters 0.11610772711643158 Centerline is valid? [True, False] Translation: X:-4.86, Y:-11.39, Z:-1.95 [[ 0.93856735 0.34397304 0.0278186 -4.85626561] [ -0.34348803 0.92338058 0.17141843 -11.39266934] [ 0.03327616 -0.1704431 0.98480549 -1.95452315] [ 0. 0. 0. 1. ]] SLAMing on 11.191463509 meters 0.1359427977787247 Centerline is valid? [False, False] Translation: X:-4.93, Y:-11.36, Z:-1.96 [[ 0.95046316 0.31028829 0.01846488 -4.92921542] [ -0.30926843 0.93803554 0.15634055 -11.36117008] [ 0.03118992 -0.15430654 0.9875306 -1.9594911 ] [ 0. 0. 0. 1. ]] SLAMing on 11.221463509 meters 0.455500121898841 Centerline is valid? [False, False] Translation: X:-5.00, Y:-11.31, Z:-1.97 [[ 0.95737676 0.28738475 0.02897841 -5.00479536] [ -0.2880977 0.94289359 0.16718673 -11.3059095 ] [ 0.02072336 -0.1684093 0.98549929 -1.97101861] [ 0. 0. 0. 1. ]] SLAMing on 11.251463509 meters 0.4663459679646439 Centerline is valid? [False, False] Translation: X:-5.08, Y:-11.24, Z:-1.99 [[ 9.65774880e-01 2.55746754e-01 4.32721537e-02 -5.07846335e+00] [-2.59377170e-01 9.51234671e-01 1.66961323e-01 -1.12398754e+01] [ 1.53784354e-03 -1.72470861e-01 9.85013420e-01 -1.99465998e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 11.281463509 meters 0.4325219767280485 Centerline is valid? [False, False] Translation: X:-5.16, Y:-11.17, Z:-2.03 [[ 0.97414663 0.21733464 0.06167647 -5.15686707] [ -0.22464742 0.96077452 0.16262181 -11.17056162] [ -0.02391383 -0.17227294 0.98475894 -2.03081103] [ 0. 0. 0. 1. ]] SLAMing on 11.311463509 meters 0.4748439225943453 Centerline is valid? [False, False] Translation: X:-5.25, Y:-11.11, Z:-2.06 [[ 0.9796272 0.1860392 0.07563046 -5.25144016] [ -0.19600706 0.96772704 0.15838437 -11.11043873] [ -0.04372394 -0.16998175 0.98447673 -2.06034862] [ 0. 0. 0. 1. ]] SLAMing on 11.341463509 meters 0.45172662143733056 Centerline is valid? [False, False] Translation: X:-5.34, Y:-11.06, Z:-2.08 [[ 0.98308544 0.16014464 0.08886347 -5.34201601] [ -0.17218175 0.97351367 0.15041472 -11.0606848 ] [ -0.06242169 -0.16317119 0.98462109 -2.07868974] [ 0. 0. 0. 1. ]] SLAMing on 11.371463509 meters 0.3796979540269964 Centerline is valid? [False, False] Translation: X:-5.42, Y:-11.02, Z:-2.10 [[ 0.98641144 0.13145838 0.09854522 -5.41964567] [ -0.14526591 0.97805415 0.14935827 -11.01782573] [ -0.07674816 -0.16164397 0.98386023 -2.09516351] [ 0. 0. 0. 1. ]] SLAMing on 11.401463509000001 meters 0.3460449092792266 Centerline is valid? [False, False] Translation: X:-5.51, Y:-10.98, Z:-2.10 [[ 0.98815829 0.10904677 0.10794442 -5.50825337] [ -0.12395633 0.98196731 0.14274112 -10.98110668] [ -0.09043244 -0.15443121 0.98385618 -2.10016938] [ 0. 0. 0. 1. ]] SLAMing on 11.431463509 meters 0.3101824229278196 Centerline is valid? [False, False] Translation: X:-5.58, Y:-10.95, Z:-2.10 [[ 0.99029394 0.07868368 0.11457222 -5.58283041] [ -0.0953516 0.98435841 0.1481438 -10.94703839] [ -0.10112363 -0.15763055 0.98230679 -2.103612 ] [ 0. 0. 0. 1. ]] SLAMing on 11.461463509 meters 0.29478004030706334 Centerline is valid? [False, False] Translation: X:-5.66, Y:-10.93, Z:-2.10 [[ 0.99134521 0.06520866 0.11394082 -5.66483935] [ -0.08111198 0.98667556 0.14103964 -10.92518543] [ -0.10322562 -0.14906094 0.98342529 -2.10034735] [ 0. 0. 0. 1. ]] SLAMing on 11.491463509 meters 0.27672263898583416 Centerline is valid? [False, False] Translation: X:-5.74, Y:-10.91, Z:-2.10 [[ 0.99153297 0.05470498 0.11776985 -5.74113436] [ -0.07127023 0.9873846 0.14139378 -10.90792734] [ -0.1085492 -0.14859008 0.98292322 -2.09647138] [ 0. 0. 0. 1. ]] SLAMing on 11.521463509 meters 0.2651556483826616 Centerline is valid? [False, False] Translation: X:-5.80, Y:-10.90, Z:-2.09 [[ 0.99147406 0.05437925 0.11841485 -5.79980954] [ -0.0704097 0.9882443 0.13570435 -10.89812977] [ -0.1096433 -0.1428849 0.98364742 -2.09069921] [ 0. 0. 0. 1. ]] SLAMing on 11.551463509 meters 0.24209761013643116 Centerline is valid? [False, False] Translation: X:-5.87, Y:-10.89, Z:-2.08 [[ 0.99230564 0.05208292 0.11232489 -5.86633167] [ -0.06737976 0.98827615 0.13700446 -10.88780266] [ -0.10387242 -0.14351873 0.98418133 -2.08004623] [ 0. 0. 0. 1. ]] SLAMing on 11.581463509 meters 0.2325995538993535 Centerline is valid? [False, False] Translation: X:-5.92, Y:-10.88, Z:-2.07 [[ 0.99202693 0.05151107 0.1150182 -5.92400468] [ -0.06643811 0.98928939 0.12997105 -10.87853141] [ -0.10709134 -0.13657638 0.98482401 -2.07436672] [ 0. 0. 0. 1. ]] SLAMing on 11.611463509 meters 0.2114173437092825 Centerline is valid? [False, False] Translation: X:-5.99, Y:-10.87, Z:-2.07 [[ 0.99271766 0.04952017 0.10981531 -5.98650712] [ -0.0635076 0.98976783 0.12777489 -10.86896469] [ -0.10236422 -0.1338185 0.98570491 -2.06559545] [ 0. 0. 0. 1. ]] SLAMing on 11.641463509 meters 0.15983978519574848 Centerline is valid? [False, False] Translation: X:-6.27, Y:-10.84, Z:-2.02 [[ 0.99398132 0.02586295 0.10645304 -6.27287045] [ -0.03913792 0.99143865 0.12456978 -10.84088678] [ -0.10231992 -0.12798638 0.98648372 -2.02277174] [ 0. 0. 0. 1. ]] SLAMing on 11.671463509 meters 0.15773620841219962 Centerline is valid? [False, False] Translation: X:-6.29, Y:-10.84, Z:-2.01 [[ 0.99576964 0.01252115 0.09102767 -6.28949689] [ -0.02318008 0.99286134 0.11700019 -10.83509051] [ -0.08891288 -0.11861527 0.98895142 -2.01147778] [ 0. 0. 0. 1. ]] SLAMing on 11.701463509 meters 0.15673463671926632 Centerline is valid? [False, False] Translation: X:-6.31, Y:-10.83, Z:-2.00 [[ 9.97146840e-01 1.64214407e-03 7.54684252e-02 -6.30945078e+00] [-1.02847524e-02 9.93395986e-01 1.14274400e-01 -1.08285666e+01] [-7.47823756e-02 -1.14724531e-01 9.90578557e-01 -1.99901552e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 11.731463509000001 meters 0.15683446774762408 Centerline is valid? [False, False] Translation: X:-6.34, Y:-10.83, Z:-2.00 [[ 9.97197585e-01 5.25385288e-03 7.46282335e-02 -6.33758561e+00] [-1.25893873e-02 9.95090296e-01 9.81672523e-02 -1.08250628e+01] [-7.37460746e-02 -9.88316707e-02 9.92367783e-01 -1.99882030e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 11.761463509 meters 0.14984956193864882 Centerline is valid? [False, False] Translation: X:-6.37, Y:-10.82, Z:-2.00 [[ 9.97706434e-01 4.19596785e-03 6.75593516e-02 -6.36962086e+00] [-1.04784257e-02 9.95619558e-01 9.29080119e-02 -1.08218629e+01] [-6.68735727e-02 -9.34028369e-02 9.93380006e-01 -1.99502966e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 11.791463509 meters 0.14664871106055571 Centerline is valid? [False, False] Translation: X:-6.38, Y:-10.82, Z:-1.99 [[ 9.98006176e-01 2.34509985e-03 6.30727687e-02 -6.38252537e+00] [-7.74708555e-03 9.96304671e-01 8.55393761e-02 -1.08208622e+01] [-6.26390957e-02 -8.58574557e-02 9.94336382e-01 -1.98711489e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 11.821463509 meters 0.14435552867834803 Centerline is valid? [False, False] Translation: X:-6.40, Y:-10.82, Z:-1.98 [[ 9.98636318e-01 4.66754667e-03 5.19973009e-02 -6.40379633e+00] [-8.59383656e-03 9.97105440e-01 7.55439427e-02 -1.08201203e+01] [-5.14941867e-02 -7.58877810e-02 9.95785817e-01 -1.98301900e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 11.851463509 meters 0.14315755609699965 Centerline is valid? [False, False] Translation: X:-6.41, Y:-10.82, Z:-1.98 [[ 9.98709557e-01 2.00381178e-03 5.07464834e-02 -6.40769674e+00] [-5.68210787e-03 9.97356320e-01 7.24436621e-02 -1.08180869e+01] [-5.04671624e-02 -7.26385246e-02 9.96080675e-01 -1.97853885e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 11.881463509 meters 0.1422768962166476 Centerline is valid? [False, False] Translation: X:-6.42, Y:-10.82, Z:-1.97 [[ 9.98906888e-01 4.01041997e-03 4.65719371e-02 -6.41844958e+00] [-7.17474386e-03 9.97661030e-01 6.79778754e-02 -1.08188076e+01] [-4.61903870e-02 -6.82377097e-02 9.96599249e-01 -1.97395087e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 11.911463509 meters 0.13860462683848015 Centerline is valid? [False, False] Translation: X:-6.43, Y:-10.82, Z:-1.97 [[ 9.99109668e-01 6.12921357e-03 4.17409056e-02 -6.42766659e+00] [-8.76200192e-03 9.97963259e-01 6.31867191e-02 -1.08209500e+01] [-4.12686053e-02 -6.34961959e-02 9.97128445e-01 -1.97069962e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 11.941463509 meters 0.14022847510199585 Centerline is valid? [False, False] Translation: X:-6.43, Y:-10.82, Z:-1.97 [[ 9.99110600e-01 4.69074178e-03 4.19047217e-02 -6.42989788e+00] [-7.27499637e-03 9.98066259e-01 6.17318236e-02 -1.08212087e+01] [-4.15341207e-02 -6.19817760e-02 9.97212704e-01 -1.96853316e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 11.971463509 meters 0.1399167649610527 Centerline is valid? [False, False] Translation: X:-6.43, Y:-10.82, Z:-1.97 [[ 9.99120110e-01 1.88089223e-03 4.18983138e-02 -6.43190852e+00] [-4.34071834e-03 9.98266461e-01 5.86960938e-02 -1.08213305e+01] [-4.17152805e-02 -5.88263164e-02 9.97396260e-01 -1.96659059e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 12.001463509 meters 0.1403439620520416 Centerline is valid? [False, False] Translation: X:-6.43, Y:-10.82, Z:-1.97 [[ 9.99109427e-01 2.11304200e-03 4.21412866e-02 -6.43237561e+00] [-4.59826094e-03 9.98249514e-01 5.89640922e-02 -1.08214085e+01] [-4.19429252e-02 -5.91053570e-02 9.97370216e-01 -1.96631554e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 12.031463509 meters 0.1391202172135485 Centerline is valid? [False, False] Translation: X:-6.43, Y:-10.82, Z:-1.97 [[ 9.99116320e-01 -9.33471331e-04 4.20203246e-02 -6.43134433e+00] [-1.41829833e-03 9.98435206e-01 5.59028440e-02 -1.08227276e+01] [-4.20067551e-02 -5.59130412e-02 9.97551585e-01 -1.96728729e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 12.061463509 meters 0.14059815814048385 Centerline is valid? [False, False] Translation: X:-6.43, Y:-10.82, Z:-1.97 [[ 9.99090152e-01 -4.22749774e-03 4.24381550e-02 -6.43078210e+00] [ 1.98680907e-03 9.98608261e-01 5.27028753e-02 -1.08234006e+01] [-4.26018935e-02 -5.25706071e-02 9.97708079e-01 -1.96832081e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 12.091463509 meters 0.14010508026521457 Centerline is valid? [False, False] Translation: X:-6.43, Y:-10.82, Z:-1.97 [[ 9.99004505e-01 -1.14936562e-02 4.31033076e-02 -6.43010019e+00] [ 9.53680311e-03 9.98926403e-01 4.53331191e-02 -1.08237373e+01] [-4.35780753e-02 -4.48769224e-02 9.98041589e-01 -1.96959515e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 12.121463509 meters 0.13929088166466855 Centerline is valid? [False, False] Translation: X:-6.43, Y:-10.83, Z:-1.97 [[ 0.99895777 -0.01474404 0.04319704 -6.4261938 ] [ 0.01291552 0.99902117 0.04230714 -10.8252475 ] [ -0.04377853 -0.04170513 0.99817039 -1.9737997 ] [ 0. 0. 0. 1. ]] SLAMing on 12.151463509000001 meters 0.14075554748815597 Centerline is valid? [False, False] Translation: X:-6.42, Y:-10.83, Z:-1.98 [[ 0.99883065 -0.02091183 0.04358927 -6.42399068] [ 0.01932446 0.99914587 0.03652524 -10.82603701] [ -0.04431585 -0.03564019 0.99838163 -1.97550645] [ 0. 0. 0. 1. ]] SLAMing on 12.181463509 meters 0.1400092896967674 Centerline is valid? [False, False] Translation: X:-6.42, Y:-10.83, Z:-1.98 [[ 0.99884758 -0.02076245 0.04327162 -6.42001438] [ 0.01913947 0.99910996 0.03758945 -10.82962902] [ -0.04401355 -0.03671793 0.99835595 -1.97854335] [ 0. 0. 0. 1. ]] SLAMing on 12.211463509 meters 0.14295167209040563 Centerline is valid? [False, False] Translation: X:-6.41, Y:-10.83, Z:-1.98 [[ 0.99908756 -0.01763203 0.03889936 -6.40923578] [ 0.01637921 0.99934421 0.03229366 -10.83427803] [ -0.03944325 -0.03162705 0.99872116 -1.97779062] [ 0. 0. 0. 1. ]] SLAMing on 12.241463509 meters 0.14540914525905502 Centerline is valid? [False, False] Translation: X:-6.41, Y:-10.84, Z:-1.98 [[ 0.99901328 -0.01932324 0.03998847 -6.40660034] [ 0.01803326 0.99931319 0.03237202 -10.83821301] [ -0.04058653 -0.03161896 0.99867561 -1.97959681] [ 0. 0. 0. 1. ]] SLAMing on 12.271463509 meters 0.148569927832848 Centerline is valid? [False, False] Translation: X:-6.39, Y:-10.85, Z:-1.98 [[ 0.99924083 -0.0135862 0.03651271 -6.39412384] [ 0.01247891 0.99946037 0.03038498 -10.84577845] [ -0.03690582 -0.02990628 0.99887115 -1.98129952] [ 0. 0. 0. 1. ]] SLAMing on 12.301463509 meters 0.1533514979357366 Centerline is valid? [False, False] Translation: X:-6.39, Y:-10.85, Z:-1.98 [[ 0.99920908 -0.01596764 0.03641758 -6.39121082] [ 0.01491434 0.99946775 0.02901337 -10.84813152] [ -0.03686147 -0.02844727 0.9989154 -1.98270034] [ 0. 0. 0. 1. ]] SLAMing on 12.331463509 meters 0.15143868925804174 Centerline is valid? [False, False] Translation: X:-6.38, Y:-10.86, Z:-1.98 [[ 9.99400475e-01 -9.33720034e-03 3.33392798e-02 -6.38347302e+00] [ 8.32902992e-03 9.99507613e-01 3.02515942e-02 -1.08553262e+01] [-3.36053292e-02 -2.99557738e-02 9.98986153e-01 -1.98206761e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 12.361463509 meters 0.15306033364178953 Centerline is valid? [False, False] Translation: X:-6.37, Y:-10.86, Z:-1.98 [[ 9.99521123e-01 -1.02335423e-02 2.92027235e-02 -6.37466967e+00] [ 9.54161865e-03 9.99672736e-01 2.37355886e-02 -1.08580917e+01] [-2.94360657e-02 -2.34455809e-02 9.99291661e-01 -1.98121594e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 12.391463509 meters 0.15306033364178953 Centerline is valid? [False, False] Translation: X:-6.37, Y:-10.86, Z:-1.98 [[ 9.99521123e-01 -1.02335423e-02 2.92027235e-02 -6.37466967e+00] [ 9.54161865e-03 9.99672736e-01 2.37355886e-02 -1.08580917e+01] [-2.94360657e-02 -2.34455809e-02 9.99291661e-01 -1.98121594e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 12.421463509 meters 0.15617887804597025 Centerline is valid? [False, False] Translation: X:-6.37, Y:-10.86, Z:-1.98 [[ 0.99952475 -0.01156018 0.02857677 -6.37090981] [ 0.01089255 0.99966663 0.02340894 -10.86059152] [ -0.02883785 -0.02308654 0.99931746 -1.98316662] [ 0. 0. 0. 1. ]] SLAMing on 12.451463509 meters 0.16391411959111318 Centerline is valid? [False, False] Translation: X:-6.36, Y:-10.87, Z:-1.99 [[ 9.99625849e-01 -6.97952038e-03 2.64470754e-02 -6.35568943e+00] [ 6.44549458e-03 9.99774698e-01 2.02239711e-02 -1.08676890e+01] [-2.65822704e-02 -2.00459398e-02 9.99445618e-01 -1.98724797e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 12.481463509000001 meters 0.16435574614501042 Centerline is valid? [False, False] Translation: X:-6.36, Y:-10.87, Z:-1.99 [[ 9.99627765e-01 -7.12663459e-03 2.63351988e-02 -6.35515734e+00] [ 6.57624720e-03 9.99759375e-01 2.09271422e-02 -1.08709200e+01] [-2.64780020e-02 -2.07461656e-02 9.99434096e-01 -1.98707752e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 12.511463509 meters 0.16629924261470205 Centerline is valid? [False, False] Translation: X:-6.35, Y:-10.87, Z:-1.99 [[ 9.99651645e-01 -8.76146574e-03 2.48962867e-02 -6.35079807e+00] [ 8.27003177e-03 9.99770269e-01 1.97741172e-02 -1.08731031e+01] [-2.50638175e-02 -1.95613357e-02 9.99494452e-01 -1.98939999e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 12.541463509 meters 0.16849748538628412 Centerline is valid? [False, False] Translation: X:-6.35, Y:-10.87, Z:-1.99 [[ 9.99659018e-01 -9.64924936e-03 2.42639628e-02 -6.34791589e+00] [ 9.17107205e-03 9.99763045e-01 1.97419541e-02 -1.08748938e+01] [-2.44487084e-02 -1.95126959e-02 9.99510638e-01 -1.99079175e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 12.571463509 meters 0.17705822161260026 Centerline is valid? [False, False] Translation: X:-6.34, Y:-10.88, Z:-1.99 [[ 9.99725239e-01 -5.50075421e-03 2.27857108e-02 -6.33784231e+00] [ 5.15218298e-03 9.99869240e-01 1.53283596e-02 -1.08813135e+01] [-2.28670489e-02 -1.52067518e-02 9.99622855e-01 -1.99085196e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 12.601463509 meters 0.18241665450908828 Centerline is valid? [False, False] Translation: X:-6.33, Y:-10.88, Z:-1.99 [[ 9.99743699e-01 -5.81435502e-03 2.18799094e-02 -6.33342557e+00] [ 5.46208982e-03 9.99855058e-01 1.61254050e-02 -1.08830786e+01] [-2.19704969e-02 -1.60017620e-02 9.99630552e-01 -1.99341045e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 12.631463509 meters 0.18652931906261624 Centerline is valid? [False, False] Translation: X:-6.33, Y:-10.89, Z:-2.00 [[ 9.99743400e-01 -9.07293183e-03 2.07560999e-02 -6.32987599e+00] [ 8.79587761e-03 9.99871519e-01 1.34006651e-02 -1.08855752e+01] [-2.08750165e-02 -1.32146584e-02 9.99694757e-01 -1.99518316e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 12.661463509 meters 0.1872189230391091 Centerline is valid? [False, False] Translation: X:-6.33, Y:-10.89, Z:-2.00 [[ 9.99752181e-01 -8.12305654e-03 2.07266361e-02 -6.32935412e+00] [ 7.81335556e-03 9.99857271e-01 1.49796559e-02 -1.08875750e+01] [-2.08453584e-02 -1.48139990e-02 9.99672955e-01 -1.99502180e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 12.691463509 meters 0.19275697633559946 Centerline is valid? [False, False] Translation: X:-6.33, Y:-10.89, Z:-2.00 [[ 9.99761159e-01 -8.88427840e-03 1.99673231e-02 -6.32776248e+00] [ 8.60007018e-03 9.99861126e-01 1.42747460e-02 -1.08894240e+01] [-2.00913710e-02 -1.40996162e-02 9.99698723e-01 -1.99531657e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 12.721463509 meters 0.19521502610486718 Centerline is valid? [False, False] Translation: X:-6.32, Y:-10.89, Z:-2.00 [[ 9.99819364e-01 -6.65071655e-03 1.78046979e-02 -6.32221494e+00] [ 6.33995971e-03 9.99827574e-01 1.74535569e-02 -1.08932387e+01] [-1.79177066e-02 -1.73375231e-02 9.99689135e-01 -1.99842046e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 12.751463509 meters 0.20466364793076489 Centerline is valid? [False, False] Translation: X:-6.31, Y:-10.90, Z:-2.00 [[ 9.99706645e-01 -4.08612144e-03 2.38731742e-02 -6.31093168e+00] [ 3.83340768e-03 9.99936238e-01 1.06218708e-02 -1.08962140e+01] [-2.39150543e-02 -1.05272392e-02 9.99658565e-01 -2.00095479e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 12.781463509 meters 0.2079514153389465 Centerline is valid? [False, False] Translation: X:-6.29, Y:-10.90, Z:-2.01 [[ 9.99742603e-01 2.36698324e-03 2.25637850e-02 -6.29496857e+00] [-2.53557095e-03 9.99969064e-01 7.44592635e-03 -1.09000594e+01] [-2.25454626e-02 -7.50122187e-03 9.99717677e-01 -2.00529936e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 12.811463509 meters 0.2122081489190616 Centerline is valid? [False, False] Translation: X:-6.29, Y:-10.90, Z:-2.01 [[ 9.99771531e-01 -2.62162823e-03 2.12135197e-02 -6.28612886e+00] [ 2.50957433e-03 9.99982768e-01 5.30709124e-03 -1.08973095e+01] [-2.12270674e-02 -5.25264182e-03 9.99760882e-01 -2.00801321e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 12.841463509 meters 0.21658435436981993 Centerline is valid? [False, False] Translation: X:-6.28, Y:-10.90, Z:-2.01 [[ 9.99792213e-01 -5.72266605e-03 1.95647997e-02 -6.28046807e+00] [ 5.66720228e-03 9.99979768e-01 2.88914572e-03 -1.08958583e+01] [-1.95809374e-02 -2.77766772e-03 9.99804417e-01 -2.01039150e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 12.871463509 meters 0.22518683723968674 Centerline is valid? [False, False] Translation: X:-6.26, Y:-10.90, Z:-2.02 [[ 9.99734377e-01 -3.90790711e-04 2.30439496e-02 -6.26367997e+00] [ 4.20056103e-04 9.99999111e-01 -1.26515478e-03 -1.08954451e+01] [-2.30434347e-02 1.27449847e-03 9.99733652e-01 -2.01655871e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 12.901463509000001 meters 0.2300928192306331 Centerline is valid? [False, False] Translation: X:-6.24, Y:-10.89, Z:-2.02 [[ 9.99687947e-01 2.48596392e-03 2.48561525e-02 -6.24383901e+00] [-2.35673102e-03 9.99983561e-01 -5.22717508e-03 -1.08927685e+01] [-2.48687384e-02 5.16696466e-03 9.99677372e-01 -2.02042000e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 12.931463509 meters 0.2341048043498433 Centerline is valid? [False, False] Translation: X:-6.23, Y:-10.88, Z:-2.02 [[ 9.99759093e-01 -4.32964868e-03 2.15176625e-02 -6.22745553e+00] [ 4.44162468e-03 9.99976829e-01 -5.15884578e-03 -1.08824908e+01] [-2.14948280e-02 5.25317636e-03 9.99755158e-01 -2.02235776e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 12.961463509 meters 0.23309340462280384 Centerline is valid? [False, False] Translation: X:-6.22, Y:-10.88, Z:-2.02 [[ 9.99809701e-01 -3.83535809e-03 1.91272596e-02 -6.22150295e+00] [ 3.91045260e-03 9.99984787e-01 -3.89019115e-03 -1.08755153e+01] [-1.91120484e-02 3.96424709e-03 9.99809489e-01 -2.02321115e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 12.991463509 meters 0.2398898814208305 Centerline is valid? [False, False] Translation: X:-6.21, Y:-10.87, Z:-2.03 [[ 9.99719326e-01 4.96358610e-03 2.31653198e-02 -6.20678011e+00] [-4.83750055e-03 9.99973197e-01 -5.49572718e-03 -1.08663718e+01] [-2.31919774e-02 5.38212243e-03 9.99716542e-01 -2.02715836e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 13.021463509 meters 0.2434290587293504 Centerline is valid? [False, False] Translation: X:-6.20, Y:-10.85, Z:-2.03 [[ 9.99746134e-01 6.57450319e-03 2.15509583e-02 -6.20171590e+00] [-6.48781712e-03 9.99970590e-01 -4.08982950e-03 -1.08536221e+01] [-2.15772131e-02 3.94897256e-03 9.99759386e-01 -2.02819324e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 13.051463509 meters 0.2497768129404363 Centerline is valid? [False, False] Translation: X:-6.20, Y:-10.83, Z:-2.03 [[ 9.99709272e-01 1.11842360e-02 2.13608286e-02 -6.19955573e+00] [-1.11261219e-02 9.99934077e-01 -2.83751032e-03 -1.08325480e+01] [-2.13911558e-02 2.59902219e-03 9.99767805e-01 -2.02654535e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 13.081463509 meters 0.2513328339820725 Centerline is valid? [False, False] Translation: X:-6.20, Y:-10.81, Z:-2.02 [[ 9.99560218e-01 2.08955560e-02 2.10415400e-02 -6.19917068e+00] [-2.10012679e-02 9.99767852e-01 4.81555963e-03 -1.08148630e+01] [-2.09360314e-02 -5.25534086e-03 9.99767005e-01 -2.02441758e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 13.111463509 meters 0.24978674230197687 Centerline is valid? [False, False] Translation: X:-6.20, Y:-10.79, Z:-2.02 [[ 9.98930784e-01 3.85974814e-02 2.54464881e-02 -6.20462018e+00] [-3.86267349e-02 9.99253492e-01 6.58893168e-04 -1.07860345e+01] [-2.54020605e-02 -1.64110342e-03 9.99675969e-01 -2.02107119e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 13.141463509 meters 0.24653273226766143 Centerline is valid? [False, False] Translation: X:-6.23, Y:-10.75, Z:-2.02 [[ 9.98387278e-01 4.48366553e-02 3.48212236e-02 -6.22601768e+00] [-4.50424089e-02 9.98971818e-01 5.14666017e-03 -1.07494011e+01] [-3.45546621e-02 -6.70679183e-03 9.99380305e-01 -2.01890493e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 13.171463509 meters 0.23430679373961086 Centerline is valid? [False, False] Translation: X:-6.27, Y:-10.72, Z:-2.01 [[ 9.98173971e-01 4.27925046e-02 4.26324318e-02 -6.27229045e+00] [-4.29612415e-02 9.99072086e-01 3.04923165e-03 -1.07164149e+01] [-4.24623883e-02 -4.87520586e-03 9.99086171e-01 -2.00835438e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 13.201463509 meters 0.21894192442393245 Centerline is valid? [False, False] Translation: X:-6.35, Y:-10.70, Z:-2.00 [[ 9.97910437e-01 4.09239303e-02 4.99999235e-02 -6.34744879e+00] [-4.10074855e-02 9.99158630e-01 6.45993351e-04 -1.07016947e+01] [-4.99314185e-02 -2.69501465e-03 9.98749013e-01 -1.99999314e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 13.231463509 meters 0.19807504401750317 Centerline is valid? [False, False] Translation: X:-6.43, Y:-10.71, Z:-1.99 [[ 9.98354213e-01 1.98562816e-02 5.38014170e-02 -6.42910036e+00] [-1.99171152e-02 9.99801458e-01 5.94717164e-04 -1.07074949e+01] [-5.37789263e-02 -1.66530741e-03 9.98551478e-01 -1.99116536e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 13.261463509 meters 0.18616970334882962 Centerline is valid? [False, False] Translation: X:-6.51, Y:-10.72, Z:-1.98 [[ 9.98445608e-01 -3.95455293e-03 5.55943337e-02 -6.50990404e+00] [ 3.97733461e-03 9.99992046e-01 -2.99145675e-04 -1.07223010e+01] [-5.55927085e-02 5.19797953e-04 9.98453394e-01 -1.98175152e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 13.291463509 meters 0.1750079709144802 Centerline is valid? [False, False] Translation: X:-6.62, Y:-10.75, Z:-1.97 [[ 9.97016054e-01 -3.22147107e-02 7.01512640e-02 -6.61511476e+00] [ 3.20337459e-02 9.99479927e-01 3.70339343e-03 -1.07480071e+01] [-7.02340839e-02 -1.44513494e-03 9.97529491e-01 -1.96948969e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 13.321463509 meters 0.16386486515696608 Centerline is valid? [False, False] Translation: X:-6.77, Y:-10.77, Z:-1.95 [[ 9.94336129e-01 -2.82516484e-02 1.02457347e-01 -6.76826200e+00] [ 2.77243989e-02 9.99594036e-01 6.56671021e-03 -1.07739942e+01] [-1.02601273e-01 -3.68894886e-03 9.94715723e-01 -1.94526679e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 13.351463509 meters 0.16351299219926393 Centerline is valid? [False, False] Translation: X:-6.85, Y:-10.78, Z:-1.92 [[ 9.90838428e-01 -2.32444421e-02 1.33037236e-01 -6.85089415e+00] [ 2.25966483e-02 9.99724323e-01 6.37721189e-03 -1.07824994e+01] [-1.33148795e-01 -3.31259098e-03 9.91090523e-01 -1.92125153e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 13.381463509 meters 0.3093402189792887 Centerline is valid? [False, False] Translation: X:-6.87, Y:-10.78, Z:-1.91 [[ 9.87117202e-01 -2.22732540e-02 1.58440942e-01 -6.86930450e+00] [ 2.14011101e-02 9.99744980e-01 7.20880545e-03 -1.07797378e+01] [-1.58561100e-01 -3.72512381e-03 9.87342140e-01 -1.90528159e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 13.411463509 meters 0.2485681701259387 Centerline is valid? [False, False] Translation: X:-6.84, Y:-10.77, Z:-1.89 [[ 9.82245172e-01 1.05418508e-03 1.87598802e-01 -6.83701692e+00] [-3.32250234e-05 9.99985174e-01 -5.44531373e-03 -1.07724519e+01] [-1.87601761e-01 5.34240014e-03 9.82230644e-01 -1.89410424e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 13.441463509 meters 0.2956412384926715 Centerline is valid? [False, False] Translation: X:-6.77, Y:-10.77, Z:-1.89 [[ 9.74608374e-01 1.00171119e-03 2.23914077e-01 -6.77340053e+00] [ 7.00651374e-04 9.99971455e-01 -7.52316832e-03 -1.07661840e+01] [-2.23915221e-01 7.48902855e-03 9.74579852e-01 -1.88540161e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 13.471463509 meters 0.31930072098011114 Centerline is valid? [False, False] Translation: X:-6.69, Y:-10.77, Z:-1.87 [[ 9.69890693e-01 -4.11719990e-03 2.43505836e-01 -6.68610606e+00] [ 2.42847712e-03 9.99970879e-01 7.23482721e-03 -1.07650538e+01] [-2.43528532e-01 -6.42564322e-03 9.69872448e-01 -1.87369252e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 13.501463509 meters 0.3208576160086937 Centerline is valid? [False, False] Translation: X:-6.62, Y:-10.75, Z:-1.86 [[ 9.57654055e-01 -2.09716145e-03 2.87913724e-01 -6.61508854e+00] [ 2.67375883e-03 9.99995130e-01 -1.60945697e-03 -1.07526854e+01] [-2.87908946e-01 2.31111485e-03 9.57654999e-01 -1.85668768e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] SLAMing on 13.531463509 meters 0.30883394193955704 Centerline is valid? [False, False] Translation: X:-6.58, Y:-10.73, Z:-1.84 [[ 9.47256005e-01 1.02817884e-02 3.20312889e-01 -6.58085885e+00] [-6.48400762e-03 9.99895500e-01 -1.29208000e-02 -1.07302877e+01] [-3.20412265e-01 1.01623942e-02 9.47223683e-01 -1.83627826e+00] [ 0.00000000e+00 0.00000000e+00 0.00000000e+00 1.00000000e+00]] Total time of SLAM: 381.80 sec! =-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-= Saving Lidar 3D alignment track ... Completed! Saving Lidar 2D alignment track ... Completed! Writing Lidar 2D slices PTD file in binary format... Completed! Filtering the 2D slices ... |- Filtering the 2D slices ... 0%| | 0/430 [00:00