{ "schema_version": 2, "success": true, "message": "`ftol` termination condition is satisfied.", "convention": "T_body_lidar maps raw LiDAR points into rear-axle body frame", "equation": "A_ij X = X B_ij", "measured_extrinsic_used_as_initial": false, "translation_m": [ 1.2966739731400179, -0.0011818594987371798, 0.7180500518063239 ], "rotation_rpy_deg_xyz": [ -0.6862002617473892, 1.312299105350799, -0.8320898359211147 ], "quaternion_xyzw": [ -0.005904487870209512, 0.0114946916809237, -0.007192110236616905, 0.9998906353379331 ], "matrix_4x4": [ [ 0.9996322912270097, 0.014246906812619035, 0.02307180059101153, 1.2966739731400179 ], [ -0.014518387883026281, 0.9998268211466698, 0.011642342076367565, -0.0011818594987371798 ], [ -0.02290193768039828, -0.011973026435188067, 0.9996660181723022, 0.7180500518063239 ], [ 0.0, 0.0, 0.0, 1.0 ] ], "estimation": { "stations": 38, "pairs": 154, "residuals": { "pairs": 154, "translation_m": { "rms": 0.20169832880489094, "median": 0.07246524583191469, "p90": 0.2753897404824865, "p95": 0.4278425490718384, "max": 0.9413768077277793 }, "rotation_deg": { "rms": 1.6476271943239644, "median": 0.9814049617994354, "p90": 2.2430975893180514, "p95": 3.6234061615039397, "max": 5.555959014778186 }, "per_pair": [ { "pair_index": 0, "translation_m": 0.09160335763349035, "rotation_deg": 0.41678911395678336 }, { "pair_index": 1, "translation_m": 0.17342241098897876, "rotation_deg": 0.6069352741159756 }, { "pair_index": 2, "translation_m": 0.15362597338796116, "rotation_deg": 0.5006592067754067 }, { "pair_index": 3, "translation_m": 0.10307796882842468, "rotation_deg": 0.7631958047896495 }, { "pair_index": 4, "translation_m": 0.034854178949377916, "rotation_deg": 0.7924566962483651 }, { "pair_index": 5, "translation_m": 0.08229579737538087, "rotation_deg": 0.5218956920191586 }, { "pair_index": 6, "translation_m": 0.07756178891403459, "rotation_deg": 0.8901066576751191 }, { "pair_index": 7, "translation_m": 0.00515582594404776, "rotation_deg": 1.1480686598732328 }, { "pair_index": 8, "translation_m": 0.11902969080451287, "rotation_deg": 0.7250267588731203 }, { "pair_index": 9, "translation_m": 0.02041753358033973, "rotation_deg": 0.42666891550326913 }, { "pair_index": 10, "translation_m": 0.05329811381948769, "rotation_deg": 1.3070274389810175 }, { "pair_index": 11, "translation_m": 0.07255710332913211, "rotation_deg": 1.7485586508142046 }, { "pair_index": 12, "translation_m": 0.12913362654704053, "rotation_deg": 1.0437199550859728 }, { "pair_index": 13, "translation_m": 0.2784531278023029, "rotation_deg": 0.8165170023642168 }, { "pair_index": 14, "translation_m": 0.0583276394617015, "rotation_deg": 0.9536825261286082 }, { "pair_index": 15, "translation_m": 0.07766573568009734, "rotation_deg": 1.3734118987942618 }, { "pair_index": 16, "translation_m": 0.08519120540755043, "rotation_deg": 1.5504754382194925 }, { "pair_index": 17, "translation_m": 0.2392325556096795, "rotation_deg": 0.9306633614951502 }, { "pair_index": 18, "translation_m": 0.02049661768665185, "rotation_deg": 0.5434732565644916 }, { "pair_index": 19, "translation_m": 0.10141834924376554, "rotation_deg": 0.6801110152223822 }, { "pair_index": 20, "translation_m": 0.1927601584704251, "rotation_deg": 0.7704160771388004 }, { "pair_index": 21, "translation_m": 0.07237338833469728, "rotation_deg": 1.13355234535889 }, { "pair_index": 22, "translation_m": 0.2380321686720521, "rotation_deg": 0.6543633179461373 }, { "pair_index": 23, "translation_m": 0.022956329719636855, "rotation_deg": 0.34448651373739575 }, { "pair_index": 24, "translation_m": 0.17365496513981085, "rotation_deg": 0.5919072614412411 }, { "pair_index": 25, "translation_m": 0.26972044137209944, "rotation_deg": 0.394408649127183 }, { "pair_index": 26, "translation_m": 0.16479297108025018, "rotation_deg": 0.8933837591188238 }, { "pair_index": 27, "translation_m": 0.029173826915557283, "rotation_deg": 0.9823009311305465 }, { "pair_index": 28, "translation_m": 0.16558352679496174, "rotation_deg": 1.6354580097985452 }, { "pair_index": 29, "translation_m": 0.27142725327985545, "rotation_deg": 1.6832228760069097 }, { "pair_index": 30, "translation_m": 0.03804497310320746, "rotation_deg": 0.6214699590261354 }, { "pair_index": 31, "translation_m": 0.00988217602887705, "rotation_deg": 0.9654320545457507 }, { "pair_index": 32, "translation_m": 0.20932389516970148, "rotation_deg": 1.235263404784913 }, { "pair_index": 33, "translation_m": 0.23596844902340763, "rotation_deg": 0.9742253618504498 }, { "pair_index": 34, "translation_m": 0.04810773998382127, "rotation_deg": 0.40079885061586873 }, { "pair_index": 35, "translation_m": 0.1439097271676289, "rotation_deg": 0.5833810515945358 }, { "pair_index": 36, "translation_m": 0.2770879492836139, "rotation_deg": 1.7217009121491587 }, { "pair_index": 37, "translation_m": 0.2635733716233143, "rotation_deg": 0.959386216598219 }, { "pair_index": 38, "translation_m": 0.30076236456889854, "rotation_deg": 0.5341538159367174 }, { "pair_index": 39, "translation_m": 0.08917523492271737, "rotation_deg": 0.752253926704042 }, { "pair_index": 40, "translation_m": 0.2283689383450832, "rotation_deg": 1.7644222410834363 }, { "pair_index": 41, "translation_m": 0.21162807555337518, "rotation_deg": 0.893481051160724 }, { "pair_index": 42, "translation_m": 0.14042093106101866, "rotation_deg": 1.2907294157599642 }, { "pair_index": 43, "translation_m": 0.1691423878395439, "rotation_deg": 2.377216518666257 }, { "pair_index": 44, "translation_m": 0.1169779798191509, "rotation_deg": 1.3815961809053516 }, { "pair_index": 45, "translation_m": 0.1387832440968286, "rotation_deg": 1.5947217176166877 }, { "pair_index": 46, "translation_m": 0.030062828340300884, "rotation_deg": 1.0704098135809084 }, { "pair_index": 47, "translation_m": 0.0680455433006411, "rotation_deg": 1.973549636369647 }, { "pair_index": 48, "translation_m": 0.031870236699333414, "rotation_deg": 2.4723290530697546 }, { "pair_index": 49, "translation_m": 0.38250571101706576, "rotation_deg": 1.1600905208267944 }, { "pair_index": 50, "translation_m": 0.06098547660886484, "rotation_deg": 1.5193006464833663 }, { "pair_index": 51, "translation_m": 0.020049847803449816, "rotation_deg": 2.0752028054797114 }, { "pair_index": 52, "translation_m": 0.14976699977401936, "rotation_deg": 0.9032263412060769 }, { "pair_index": 53, "translation_m": 0.38104623295208556, "rotation_deg": 0.6420289897992424 }, { "pair_index": 54, "translation_m": 0.6145427269990851, "rotation_deg": 4.320949352504073 }, { "pair_index": 55, "translation_m": 0.0644413592299437, "rotation_deg": 2.803369589869878 }, { "pair_index": 56, "translation_m": 0.18425354638764108, "rotation_deg": 0.6171163774519929 }, { "pair_index": 57, "translation_m": 0.3120883490259661, "rotation_deg": 0.4259486202878496 }, { "pair_index": 58, "translation_m": 0.418016177718232, "rotation_deg": 5.044083647712121 }, { "pair_index": 59, "translation_m": 0.07897058451306387, "rotation_deg": 2.708937676342093 }, { "pair_index": 60, "translation_m": 0.20725234914942078, "rotation_deg": 1.3373510925222083 }, { "pair_index": 61, "translation_m": 0.5028731993983374, "rotation_deg": 2.560781611577359 }, { "pair_index": 62, "translation_m": 0.324052710994222, "rotation_deg": 3.4637911605755742 }, { "pair_index": 63, "translation_m": 0.16594327616277665, "rotation_deg": 1.096300100186063 }, { "pair_index": 64, "translation_m": 0.9413768077277793, "rotation_deg": 4.623227467412829 }, { "pair_index": 65, "translation_m": 0.7475763787765258, "rotation_deg": 5.251990934487642 }, { "pair_index": 66, "translation_m": 0.44609152444282213, "rotation_deg": 5.555959014778186 }, { "pair_index": 67, "translation_m": 0.8772363359544111, "rotation_deg": 3.919834020370911 }, { "pair_index": 68, "translation_m": 0.7256840115352385, "rotation_deg": 4.7791807757364335 }, { "pair_index": 69, "translation_m": 0.5540111498360015, "rotation_deg": 5.404862742811467 }, { "pair_index": 70, "translation_m": 0.05427710319100646, "rotation_deg": 0.47262999225353286 }, { "pair_index": 71, "translation_m": 0.03494523113943391, "rotation_deg": 1.5163417215367592 }, { "pair_index": 72, "translation_m": 0.04639564426856145, "rotation_deg": 1.9306722358716086 }, { "pair_index": 73, "translation_m": 0.031597675421818384, "rotation_deg": 2.0321950625908634 }, { "pair_index": 74, "translation_m": 0.06688972458549529, "rotation_deg": 1.0363014892153515 }, { "pair_index": 75, "translation_m": 0.07495539042883581, "rotation_deg": 0.879604047232473 }, { "pair_index": 76, "translation_m": 0.07523266019202682, "rotation_deg": 0.6051319351741334 }, { "pair_index": 77, "translation_m": 0.07099230127095138, "rotation_deg": 1.202238808395327 }, { "pair_index": 78, "translation_m": 0.06557199988165952, "rotation_deg": 0.6765649678327575 }, { "pair_index": 79, "translation_m": 0.12154293847124566, "rotation_deg": 0.7325970122680316 }, { "pair_index": 80, "translation_m": 0.17982574134407248, "rotation_deg": 1.5473661961917022 }, { "pair_index": 81, "translation_m": 0.04462726734001729, "rotation_deg": 0.6937634461069877 }, { "pair_index": 82, "translation_m": 0.0613023995980599, "rotation_deg": 0.8119788473937047 }, { "pair_index": 83, "translation_m": 0.08503096310423741, "rotation_deg": 1.4444141387028644 }, { "pair_index": 84, "translation_m": 0.07464123857051043, "rotation_deg": 0.7030897752540571 }, { "pair_index": 85, "translation_m": 0.029868184350228942, "rotation_deg": 0.9135621919993453 }, { "pair_index": 86, "translation_m": 0.05823954193987833, "rotation_deg": 0.5917544307877486 }, { "pair_index": 87, "translation_m": 0.0551313637068964, "rotation_deg": 1.4516548104557863 }, { "pair_index": 88, "translation_m": 0.09827472129882013, "rotation_deg": 0.42188472344008116 }, { "pair_index": 89, "translation_m": 0.044245224544806644, "rotation_deg": 1.0004748409346111 }, { "pair_index": 90, "translation_m": 0.018832180352354084, "rotation_deg": 1.51099458595063 }, { "pair_index": 91, "translation_m": 0.020467010735194163, "rotation_deg": 1.7676261200773673 }, { "pair_index": 92, "translation_m": 0.0262975474700301, "rotation_deg": 0.8325617740533534 }, { "pair_index": 93, "translation_m": 0.04446844149309418, "rotation_deg": 1.5739586103283063 }, { "pair_index": 94, "translation_m": 0.01467330858160615, "rotation_deg": 1.2850817812632396 }, { "pair_index": 95, "translation_m": 0.06870746700120084, "rotation_deg": 1.7240767243237687 }, { "pair_index": 96, "translation_m": 0.05666264876403947, "rotation_deg": 1.0206213519210603 }, { "pair_index": 97, "translation_m": 0.07342527442704463, "rotation_deg": 0.7244552191419976 }, { "pair_index": 98, "translation_m": 0.054266286757252646, "rotation_deg": 0.4989636190115999 }, { "pair_index": 99, "translation_m": 0.047207658172525445, "rotation_deg": 0.23696494205729182 }, { "pair_index": 100, "translation_m": 0.11572080515326105, "rotation_deg": 1.7515941247741897 }, { "pair_index": 101, "translation_m": 0.06407086244008413, "rotation_deg": 0.46899277183017407 }, { "pair_index": 102, "translation_m": 0.15305365572855853, "rotation_deg": 0.9523959443915215 }, { "pair_index": 103, "translation_m": 0.05122753080254304, "rotation_deg": 1.3098743656013143 }, { "pair_index": 104, "translation_m": 0.0946533848328183, "rotation_deg": 0.7612204831612559 }, { "pair_index": 105, "translation_m": 0.07481645106107998, "rotation_deg": 0.7174903795296853 }, { "pair_index": 106, "translation_m": 0.07931651617250869, "rotation_deg": 0.3160868091969118 }, { "pair_index": 107, "translation_m": 0.0656383441135373, "rotation_deg": 0.7904846161787125 }, { "pair_index": 108, "translation_m": 0.03241931291657944, "rotation_deg": 1.535299757082846 }, { "pair_index": 109, "translation_m": 0.06234488990038783, "rotation_deg": 1.5874303211040584 }, { "pair_index": 110, "translation_m": 0.03506692454461985, "rotation_deg": 0.25002484619548354 }, { "pair_index": 111, "translation_m": 0.04125822298839504, "rotation_deg": 0.8720293199565927 }, { "pair_index": 112, "translation_m": 0.051725253480973364, "rotation_deg": 1.5059976851542656 }, { "pair_index": 113, "translation_m": 0.025726583767115428, "rotation_deg": 1.5673808264017624 }, { "pair_index": 114, "translation_m": 0.027511376068390752, "rotation_deg": 0.719385406633602 }, { "pair_index": 115, "translation_m": 0.04557229476188737, "rotation_deg": 0.8566964152790454 }, { "pair_index": 116, "translation_m": 0.1301226621807897, "rotation_deg": 1.9490463203564985 }, { "pair_index": 117, "translation_m": 0.08472149919727921, "rotation_deg": 1.4400759566709866 }, { "pair_index": 118, "translation_m": 0.03305331754412625, "rotation_deg": 1.5282125278120453 }, { "pair_index": 119, "translation_m": 0.06943760420453976, "rotation_deg": 0.14382473264645845 }, { "pair_index": 120, "translation_m": 0.1387812176775449, "rotation_deg": 0.9702105493011807 }, { "pair_index": 121, "translation_m": 0.050472774524194526, "rotation_deg": 0.7112996871542888 }, { "pair_index": 122, "translation_m": 0.040960987456295526, "rotation_deg": 0.8626492437182947 }, { "pair_index": 123, "translation_m": 0.1183520030349349, "rotation_deg": 1.9037016305375127 }, { "pair_index": 124, "translation_m": 0.13482286998475895, "rotation_deg": 1.1180532382465007 }, { "pair_index": 125, "translation_m": 0.08919768111421818, "rotation_deg": 0.7424305858785966 }, { "pair_index": 126, "translation_m": 0.03295290503021982, "rotation_deg": 0.8748115525182623 }, { "pair_index": 127, "translation_m": 0.07050270871439886, "rotation_deg": 2.315052496677334 }, { "pair_index": 128, "translation_m": 0.08399613707521804, "rotation_deg": 1.3430883907512923 }, { "pair_index": 129, "translation_m": 0.07635426719286566, "rotation_deg": 0.28938877097974597 }, { "pair_index": 130, "translation_m": 0.08599980484168654, "rotation_deg": 0.3232792746340014 }, { "pair_index": 131, "translation_m": 0.08546417597482137, "rotation_deg": 1.3709646380399854 }, { "pair_index": 132, "translation_m": 0.0586834782862356, "rotation_deg": 0.6222764869215247 }, { "pair_index": 133, "translation_m": 0.06297920233905209, "rotation_deg": 1.0415437811293622 }, { "pair_index": 134, "translation_m": 0.0421890137454461, "rotation_deg": 0.6732808756041617 }, { "pair_index": 135, "translation_m": 0.03384375753290982, "rotation_deg": 0.5098352623359285 }, { "pair_index": 136, "translation_m": 0.06075109086084829, "rotation_deg": 1.672042116085701 }, { "pair_index": 137, "translation_m": 0.1123184567166834, "rotation_deg": 1.9991157673182287 }, { "pair_index": 138, "translation_m": 0.06975029753182684, "rotation_deg": 1.0328391327124684 }, { "pair_index": 139, "translation_m": 0.04075826846987665, "rotation_deg": 0.4510416388715733 }, { "pair_index": 140, "translation_m": 0.028766437036440082, "rotation_deg": 1.1094878762620817 }, { "pair_index": 141, "translation_m": 0.038764927354221934, "rotation_deg": 1.0013714467514025 }, { "pair_index": 142, "translation_m": 0.04136840051779099, "rotation_deg": 0.3534868458036239 }, { "pair_index": 143, "translation_m": 0.07880312075185329, "rotation_deg": 1.224811122150423 }, { "pair_index": 144, "translation_m": 0.022505079629904813, "rotation_deg": 1.0872300390191383 }, { "pair_index": 145, "translation_m": 0.013450514823594537, "rotation_deg": 0.271332255193449 }, { "pair_index": 146, "translation_m": 0.05540964657988301, "rotation_deg": 0.9805089924683242 }, { "pair_index": 147, "translation_m": 0.048893074003320006, "rotation_deg": 2.060862589786143 }, { "pair_index": 148, "translation_m": 0.021147862897351464, "rotation_deg": 0.5068012746071331 }, { "pair_index": 149, "translation_m": 0.04215476698638024, "rotation_deg": 1.1176937562359575 }, { "pair_index": 150, "translation_m": 0.01586414732810156, "rotation_deg": 0.5375200318464232 }, { "pair_index": 151, "translation_m": 0.012304155965152195, "rotation_deg": 0.6912196843126612 }, { "pair_index": 152, "translation_m": 0.03401108751100478, "rotation_deg": 0.5348561807666571 }, { "pair_index": 153, "translation_m": 0.0382087841988423, "rotation_deg": 2.5751575774124302 } ] } }, "ground": { "planes": 38, "body_origin_height_above_ground_m": 0.2335, "formula": "d_lidar - (R_X n_lidar)^T t_X - body_height" }, "linearized_one_sigma": { "translation_m": [ 0.003426069786439831, 0.003661463644230861, 0.005894947490840618 ], "rotation_deg": [ 0.039743045073798305, 0.03697641596170036, 0.059566156250294475 ], "warning": "conditional local estimate; bootstrap is the primary stability check" }, "weighted_jacobian_condition_number": 9.240412309046407, "solver_multistart": { "runs": 12, "candidates_relative_to_best": [ { "cost": 986.8831673974076, "success": true, "translation_m": 1.781114124910946e-10, "rotation_deg": 1.5745193455937713e-09 }, { "cost": 986.883167397408, "success": true, "translation_m": 5.536606008158485e-10, "rotation_deg": 2.217262412976666e-08 }, { "cost": 986.883167397408, "success": true, "translation_m": 5.220783796487502e-10, "rotation_deg": 8.362101120716713e-09 }, { "cost": 986.883167397408, "success": true, "translation_m": 3.678710827203267e-10, "rotation_deg": 2.260153530135103e-08 }, { "cost": 986.8831673974075, "success": true, "translation_m": 1.7534776205532575e-10, "rotation_deg": 3.2670580143957554e-09 }, { "cost": 986.8831673974074, "success": true, "translation_m": 3.469446951953614e-18, "rotation_deg": 0.0 }, { "cost": 986.8831673974096, "success": true, "translation_m": 1.5270516044070511e-09, "rotation_deg": 7.02719130732361e-08 }, { "cost": 986.8831673974074, "success": true, "translation_m": 1.2027149370934288e-10, "rotation_deg": 3.250857426548915e-09 }, { "cost": 986.8831673974076, "success": true, "translation_m": 1.3743999906846494e-10, "rotation_deg": 3.478167640260992e-09 }, { "cost": 986.8831673974076, "success": true, "translation_m": 7.561012126834818e-11, "rotation_deg": 3.398361215816758e-09 }, { "cost": 986.8831673974076, "success": true, "translation_m": 1.5936145552789374e-10, "rotation_deg": 3.5265475806436176e-09 }, { "cost": 986.8831673974076, "success": true, "translation_m": 4.3707227819079805e-10, "rotation_deg": 7.230578566209689e-09 } ] }, "bootstrap": { "runs": 100, "order": [ "x_m", "y_m", "z_m", "roll_deg", "pitch_deg", "yaw_deg" ], "std": [ 0.0016135672080709418, 0.001712659789326026, 0.0010626181065453576, 0.04873173241478149, 0.04696015710280561, 0.05195409090162765 ], "p025": [ 1.293581085997522, -0.00451064016109812, 0.7160005593474846, -0.782142502478161, 1.2412102159858718, -0.9139767554692944 ], "p975": [ 1.2994255903325156, 0.0023253494861594877, 0.7196644226938009, -0.5899348985799792, 1.40343833941121, -0.7335620940370134 ] } }